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Two single axis planetary roller-gear drives and a two 
axis roller-gear drive with dual inputs were designed for 
use as robotic transmissions. Each of the single axis 
drives is a two planet row, four planet arrangement with 
spur gears and compressively loaded cylindrical rollers 
acting in parallel. The two axis drive employs bevel gears 
and cone rollers acting in parallel. 

The rollers serve a dual function: they remove 

backlash from the system, and they transmit torque when the 
gears are not fully engaged. 

Specifications for the single axis drives, named the 
Wrist-Roll and Hinge-Joint were: 

WRIST-ROLL HINGE -JOINT 

Ratio 23.23:1 29.23:1 

Input torque 1.12 Nm (9.9 in lb) 28.94 Nm (256 in lb) 

Output torque 26 Nm (230 in lb) 845.8 Nm (7483 in lb) 

Specifications for the two axis drive', named the 
Pitch/ Yaw Joint Drive, were: 

Ratio 3.4286:1 

Dual input torques 27.1 Nm (240 in lb) 

Output torque 186.5 Nm (1650 in lb) 

Two Wrist-Roll Drives, one all steel and one containing 
alternate sets of steel and plastic rollers and gears, and 
one Hinge- Joint Drive, all steel, were fabricated, assembled 
and performance tested. Drive linearity, friction, inertia, 
backlash, stiffness and efficiency were determined with 
experimental setups employing high resolution optical 
encoders, precision torque meters, and dc servomotors with 
either proportional-plus-integral velocity or torque 
feedback control. 

For all three single axis drives, linearity was good. 
Ratio variations of the two steel drives were typically 
within 0.5%. Ratio variations of the plastic drive were as 
high as 1.5%. No backlash was observed in either of the 
steel drives (within the 0.001 degree accuracy of the 
encoders). The plastic drive exhibited a small hysteresis, 
on the order of the measurement accuracy. Dynamic 
efficiencies of up to 97% were measured for the steel 
Wrist-Roll Drive; notably, it was more efficient as a speed 
increaser than as a speed reducer. Efficiency measurements 
of the plastic Wrist-Roll Drive were influenced by two 
failures that occurred during testing. Only quasi-static 
measurements of efficiency of the Hinge-Joint Drive were 
made, with a projected efficiency of 96% at full torque. 
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A drive and control system was designed and constructed 
for use in conjunction with the Pitch/Yaw Joint. The 
control system is PC based, and was designed to drive the 
joint, input specific commands to perform single or multiple 
defined movements, measure input and output speeds and 
angular positions, measure input torques, and record all of 
these data as functions of time for use in analyzing 
performance of the joint. To accomplish these tasks a 
system of drive motors, tachometers, torque meters and input 
and output resolvers was assembled. 

Control system response was smooth and lag times 
between command and execution were typically 0.1 seconds. 
Execution times for 20° to 30° moves in pitch or yaw were 
typically 0.5 to 0.7 seconds, which translates to a pitch or 
yaw axis angular velocity of approximately 6.5 rpm. 

Static torsional stiffness measurements were made of 
the Pitch/Yaw Joint. These revealed stiffnesses of only a 
few percent of the theoretical stiffness of the roller-gear 
train, indicating that structural elements are quite soft. 
A heavier structure could significantly increase torsional 
stiffness. Some difficulties in analyzing data were 
encountered because of inertia in the torque loading system. 
Problems with torque loading system instability limited 
input torques to 75% of full load rating. Efficiencies of 
up to 98% were measured. The joint was backlash free. 
Fluctuations in output axis angular velocities (either pitch 
or yaw) of +2% were determined from differentiation of pitch 
and yaw axis position data, but limited resolver accuracy 
makes this data somewhat questionable. There may also have 
been some feedback from the dynamics of the torque loading 
system. A more meaningful assessment of joint linearity 
would require further work with a low (or preferably zero) 
inertia, damped loading system and more precise resolvers or 
encoders . 
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SYMBOLS 


C 

Cn 

D 

E 

F 

I 

J 

K 

M 

me 

N 
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P.D. 
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W 

BC 

BP 


compliance rad/in lb (rad/Nm) 
constants as defined 
deflection mm(in) 
modulus of elasticity psi, (GPa) 
force, N (lb.) 
bevel gear geometry factor 
spur gear tooth geometry factor 
stiffness in lb/rad (Nm/rad) 
measurement over pins, in. 
ratio of N G /Np 
f number of gear teeth 
[^normal load, N, (lbs.) 
gear diametral pitch 
gear pitch diameter, mm (in.) 
fdrive ratio 
[roller radius 
stress, GPa (psi) 

(tooth thickness, in. 

[torque in lbs(Nm) 
gear radial reaction force, N (lb.) 
gear axial reaction force, N (lb.) 
(Tooth deflection 
[Lewis factor 
load, N, (lbs) 
base circle diameter, in. 
basepitch 
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INTRODUCTION 


Traction drives offer advantages of high efficiency at 
high ratios, backlash free operation, low noise, no gear 
cogging, smooth torque transfer and back drivability. 
However, the maximum tangential force that can be 
transmitted through a roller contact is a function of the 
normal load and the available traction coefficient. 
Structural rigidity, materials, and lubrication mode limit 
normal loads and thus drive torque. Where space is at a 
premium and the torque to be transmitted exceeds the 
capability of a traction drive, alternative designs are 
required. 

Roller-gear drives offer an alternative approach; they 
utilize torque transfer paths in which rollers and gears 
function in parallel. The gears enhance torque capacity. 
In planetary arrangements, retention of rollers acting in 
parallel with gears has two functions: 

1. The rollers provide positioning for the gears and 
allow the use of multiple planet rows. in gear units 
without rollers, only single planet row arrangements are 
feasible; 

2. Compressively loaded rollers remove backlash from 
the torque path, attenuate gear cogging and torque ripple, 
and support the radial component of gear tooth forces. 

In non-planetary arrangements of bevel gears and bevel 
rollers the rollers supplement the torque capacity of the 
gears, remove the backlash from the torque path, attenuate 
gear cogging and torque ripple, and support the 
non-tangential components of gear tooth forces. 

As in ordinary single row planetaries, in two row 
planetaries, the low torque high speed input is supplied to 
the sun roller-gear and the high torque, low speed output is 
taken from the ring gear. Roller diameters are nominally 
equal to gear pitch diameters with a preload set at assembly 
which exceeds the gear separating force. This insures that 
the rollers will not separate and cause backlash or chatter. 
The gear teeth will then transmit purely tangential forces. 

Three row roller-gear drives can be designed in a 
fashion similar to two row drives where higher ratios are 
required. Bearings are necessary in only one of the planet 
roller-gear rows, usually the outermost row. Other planet 
roller-gears are spatially located by the rollers. 
Preloading of a roller-gear drive can be accomplished by 
employing ring rollers to compressively load the roller 
cluster, or by employing eccentric mounts for the planet 
rollers which are located on bearings. 
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Preliminary designs of three roller-gear drives were 
completed and reported in ref. 1 to assess their feasibility 
for use in a Laboratory Telerobotic Manipulator. These 
include a two axis drive which utilizes cone rollers and 
zerol bevel gears, and two single axis drives which utilize 
cylindrical rollers and spur gears. 

Technical objectives of this effort were: 

1. Complete detailed designs and manufacturing drawings 

for : 

a. A nominal 25:1 ratio single axis roller-gear drive 
for the Wrist-Roll Joint. Design two versions of the drive 
one incorporating steel gears and rollers and one 
incorporating combinations of plastic and steel gears and 
rollers . 


b. A nominal 30:1 ratio high torque capacity single 
axis Hinge Joint roller-gear drive. 

c. A 3.43:1 ratio two axis cone roller-bevel gear 
drive for the Large Pitch/ Yaw Joint. 

2 . Seek manufacturing bids and have one complete 

assembly of each of the three drives fabricated. 

Fabrication will include a spare set of rollers for each 
drive and, for the Wrist-Roll Joint drive, two sets of gears 
and rollers - one steel and one plastic. 

3. Assemble and check out drives for test. 

4. Design test facilities for experimentally 

evaluating the three drives. The test facility for each 
drive will consist of an input drive system, a torque 
applicator on the output side, torque meters for monitoring 
input and output torques, a magnetic clutch and brake for 
initiating and stopping drive motion and encoders for 
measuring angular displacement. Appropriate shafting, 

couplings and a base to interconnect the components will 
complete each test facility. Complete manufacturing 
drawings for test facility components that are not standard 
commercial items. Include instrumentation for measurement 
and readout of input and output speeds , torques and angular 
positions . 

5. Seek bids for and have fabricated non-commercial 
items for the test facilities. 

6. Purchase all commercial items for the test 

facilities. 

7. Assemble and check out test facility components 
with the drive prototypes. 
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8. Conduct an experimental evaluation of each of the 
roller-gear drives. Monitor input speed and/or angular 
position, and monitor and control output torque. Monitor 
input torque, output speed and input and output angular 
positions. These data will be taken over a range of input 
speeds and output torques. From these data drive torsional 
stiffness (in a locked mode) , efficiency and torque ripple 
characteristics will be determined. 
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DRIVE DESIGNS 


WRIST-ROLL JOINT ROLLER-GEAR DRIVE 


DESIGN 

Specifications for the Wrist-Roll drive were: 

Nominal ratio 25:1 

Output torque 26Nm (230 in. lb.) 

Output speed 120 rpm 

Maximum diameter 152.4 mm (6 inches) 


Cluster and Gear Geometry 

A cluster geometry was initially established in the 
Phase I study (ref. 1) . When carried forward into detail 
design, it was found to present some assembly difficulties 
so a slightly modified design (Ratio = 23.23) was chosen 
from the solutions available for two planet row, four planet 
arrangements (ref. 1). 

Two drive assemblies - one all steel, and one 
containing alternate steel and plastic rollers and gears are 
to be designed and fabricated. 

Detail calculations of cluster geometry, gear stresses, 
gear geometry and measurement data are given in Appendix A. 
In the section Cluster Geometry , gear diametral pitch, pitch 
diameters, and numbers of teeth, together with nominal 
roller diameters are calculated. In the section Gear 
Stresses , gear face widths necessary to keep tooth bending 
and compressive stresses acceptable are calculated for both 
steel and plastic materials. In the section Gear Geometry 
and Measurement Data , tooth geometries necessary for 
manufacture and data required for inspection of the gears 
are developed. TABLE 1 summarizes gear geometry and 
inspection data for the WRIST-ROLL DRIVE. 

Materials 

Stress conditions in the steel gears are such that an 
alloy steel of Rc 30-38 is adequate. Special gear steels 
that are nitrided or carburized for operation at higher 
stress levels are not required. Sun, planet and ring 
rollers in the all steel drive are made of AMS-6490 M-50 
tool steel. M-50 steel was chosen because the shrink fits 
required for roller mounting on the sun and first planet 
roller-gear assemblies require heating to 600° F. Fully 
hardened rollers (Rc 60) are required for the normal loads 
and Hertz stresses in the all steel drive. Bending stresses 
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in the ring roller are nominal so that a carburized steel 
with a soft core is not required. 

For the steel-plastic drive, Delrin 100 acetal resin 
polymer was chosen for the plastic gears because of 
extensive design and use experience in a wide array of gear 
applications. Procedures for designing Delrin 100 gears are 
given in reference 2. As in the all steel drive, the steel 
gears are an alloy steel of Rc 30-38, Torlon 4203 poly 
(amide-imide) resin was chosen for the plastic rollers. It 
has high strength over a wide temperature range (ref. 3). 
Steel rollers are of AISI 4340 alloy steel, Rc 39-42. Use 
of fully hardened rollers mating with poly (amide-imide) 
resin rollers is not necessary. Gear and roller material 
combinations for the steel-plastic Wrist-Roll Drive are 
shown in TABLE 2. TABLE 3 shows the gear and roller 
material contact combinations for the steel-plastic drive. 

Roller Sizing 

A number of iterative calculations of roller torque 
fraction, normal load and Hertzian contact were made to 
determine a feasible level of torque that could be carried 
through the rollers without extending roller widths much 
beyond .125 inches. A torque fraction of .20 was settled 
upon as reasonable. A traction coefficient of .06 was 
assumed for the Steel vs. Steel rollers (assuming traction 
oil or traction grease lubrication) and one of .15 was 
assumed for the Steel vs. Torlon rollers (assuming dry 
operation) . Steel vs. Steel rollers were configured as 
straight cylinders with line contact except for the ring 
roller which was crowned for ease of assembly. Steel vs. 
Torlon rollers were configured as straight vs. crowned 
cylinders with elliptic contacts to eliminate edge effects 
with the torlon rollers. 


Roller Diameter, Load ,N ( lbs) Width, Max Hertz 



mm (in) 



mm ( in) 

Stress, GPa, (KSI) 

a 

X 1 

14.2 (.558) 
30.1 (1.185) 

129 

(29 

3.18 

(.125) 

.52 

(75.6) 

y 

x 2 

9.98 (.393) 
39.73 (1.564) 

703 

(158) 

3.30 

(.130) 

1.38 

(201) 

y 2 

c 

40.28 (1.586) 
110.1 (4.335) 

1081 

(243) 

3.18 

(.125) 

0.57 

(82) 
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The Steel vs. Torlon roller data, 
transfer and u = .15 are as follows: 


for 20% torque 


Roller Diameter , 
mm (in) 


Load ,N ( lbs) Cross Contact Max Hertz 

Radius , Width Stress GPa (KSI ) 
mm ( in) mm (in) 


a 14 . 2 ( . 558) 

26(5.85) 

x x 30.1(1.185) 
y 9 . 98 ( . 393 ) 

141 (31.7) 

x 2 39.73(1.564) 
y 2 40.28(1.586) 218(48.9) 
c 110.1(4.335) 


127(5) 

2.24 ( .088) 

.08 

(11.7) 

76.2(3) 

3 .2 ( .126) 

.17 

(25) 


2.69 (.106) 

.09 

(12.8) 


63.5(2.5) 


Because of the low modulus of Torlon (4.83 GPa [700 
KSI]) approximately 97 percent of the contact deformation 
occurs in the Torlon. Hertzian deformations in the roller 
contacts are as follows: 


Roller Steel vs. Steel, mm(in) Steel vs. Torlon, mm (in) 


a x 1 

7 . 87xl0 -4 

( 3 . lxlO -5 ) 

6 . 86xl0 -3 

(2 . 7xl0 -4 ) 

Yl x 2 

3 . 35xl0~ 3 

(1 .32xl0 -4 ) 

2 . 44xl0 -2 

( 9 . 6xl0~ 4 ) 

y 2 c 

6 . 35xl0 -3 

(2.5xl0 -4 ) 

2 . 54xl0 -2 

( lxlO -2 ) 

the 

Steel 

Roller effective radii were 
deformation to occur in 
-Torlon drive. 

calculated 
the Torlon 

assuming all of 
rollers for the 


The radial 
determined to 


bending deflection of the ring roller was 
be 2.79xl0 -2 mm (.00011 in) for the 


mm 

Steel-Tor Ion drive and 1.39xl0 -2 mm (.00055 in) for the 
Steel-Steel drive (ref. 4, p. 224). The operating diameter 
of the ring roller, after Hertzian deformation and bending 
deflection, should be the operating pitch diameter of gear c 
(110 
the 


14 mm (4.3361 in), APPENDIX A). Nominal diameters of 
ring rollers were set at 110.11 mm (4.3351 in) for the 


and 110.13 


mm 


(4.3359 in) for the 


Steel-Steel drive 
Steel-Torlon drive. 

The theoretical diameter over 
rollers before mounting the ring 
(4.3369 in) for the Steel-Steel drive and 110.254 mm (4.3407 
in) for the Steel-Torlon drive. Thus the interference fits 
to be overcome in mounting the ring rollers are 


the second row planet 
rollers is 110.157 mm 
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.0457 mm (.0018 in) for the Steel-Steel drive, and 
.1219 mm (.0048 in) for the Steel-Torlon drive, 

with a 63.5 mm (2.5 in) crown radius on the ring roller 
inside diameter, the crown drop (.03 mm (.0012 in)) is 
sufficient for assembly of the Steel-Steel drive. For the 
Steel-Torlon drive, the ring roller should be preheated to 
approximately 225° F. 

Roller diameters and drawing sources for both the 
Steel-Steel and Steel-Torlon drives are given in TABLE 4. 


Drawings 

Design of the Steel-Steel drive is defined by assembly 
drawings NAS-140A and NAS-140B and detail drawings NAS-141 
through NAS-181 inclusive. Commercial parts required for 
assembly are defined on these detail drawings. Design of 
the steel-plastic drive is defined by assembly drawings 
NAS-140AP and NAS-140B and the following detail drawings: 


NAS-142P 
NAS -14 4 
NAS-145 
NAS-1 4 6P 
NAS-147 


NAS-1 4 8P 

NAS-149P 

NAS-150 

NAS-151 

NAS-152P 


NAS-153 

NAS-154P 

NAS-155 

NAS-156P 


and NAS-157 through NAS-184 inclusive. Commercial parts 
required for assembly are defined on these detail drawings. 

The assembly fixture required for assembly of both 
drives is shown on drawings NAS-185 and NAS-186. 
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WRIST ROLL ROLLER-GEAR DRIVE ASSEMBLY PROCEDURE 
ALL STEEL DRIVE - ASSEMBLY DRAWING NAS-1 4 OA 

1. Lay the Assembly Fixture, NAS-186, flat on a table. 

2. Place the Sun Roller Gear Assembly, NAS-143, on the 
center post of the Assembly Fixture with the shaft extension 
inserted into the center post hole. 

3. Using Dykem marking compound or equivalent, mark four 
equally spaced tooth spaces on the Sun Gear. Orient these 
four spaces to face the four equally spaced holes in the 
Assembly Fixture. 

4. Highlight the indexed tooth on the large central gear of 
each of four 1st Row Roller Gear Assemblies, NAS-149. 

5. Radially assemble a 1st Row Roller Gear Assembly with 
the Sun Roller Gear Assembly so that the marked indexed 
tooth goes into a marked tooth space. Index the Assembly 
Fixture on the table so that the shaft extension on the 1st 
Row Roller Gear Assembly can be inserted into an Assembly 
Pin, NAS-185. 

6. Repeat steps for the remaining three 1st Row Roller Gear 
Assemblies. At this time the Assembly Fixture should be 
resting on the four Assembly Pin heads. 

7. Press fit needle Roller Bearings, NAS-151, into each of 
four 2nd Row Gears, NAS-152. 

8. Assemble one 2nd Row Roller, NAS-154, onto each 2nd Row 
Gear with Screws, NAS-153. 

9. Assemble a key, NAS-170, two Bearing Races, NAS-164, and 
a Planet Shaft Spacer, NAS-163, onto each of four Planet 
Shafts, NAS-162. 

10. Insert the Planet Shaft assemblies into the 2nd Row 
Gears and assemble these into each of four slots in the 
Assembly Fixture. Make certain that proper gear mesh and 
roller contact is made. Planet Shaft keys must properly fit 
into the key slots. The previously assembled 2nd Row 
Rollers should be laying on the side nearest the Assembly 
Fixture plate. It may be necessary to hold the Planet 
Shafts in the Assembly Fixture plate with nuts. 

11. Assemble a Ring Support Washer, NAS-167, onto the top 
of each Planet Shaft assembly. 

12. Assemble the Planet Shaft Ring Support, NAS-165, to the 
Planet Shafts and tighten with Ring Support Nuts, NAS-168. 


14 



13. Assemble two Ring Gear Dowels, NAS-157, and two Ring 
Gear Dowels, NAS-161, to the Ring Gear, NAS-155. 

14. Assemble the Ring Gear to the four 2nd Row Gears from 
the top. This requires patience and deft maneuvering to 
obtain the proper mesh. The side with the shorter dowels 
should face down. With the Ring Gear in place, remove the 
Planet Shaft Ring Support. 

15. The remaining four 2nd Row Rollers can now be assembled 
to the 2nd Row Gears. Reassemble the Planet Shaft Ring 
Support. 

16. Assemble two Ring Rollers, NAS-156, to the 2nd Row 
Rollers and Ring Gear taking care to properly align dowels 
with dowel holes. 

17. Assemble two Output Shaft Dowels, NAS-173, to the 
Output Shaft Adapter, NAS-171. 

18. The Output Shaft Adapter, can now be assembled to the 
Ring Roller. Bolt the Adapter in place with Ring Gear 
Bolts, NAS-158, and Ring Gear Nuts, NAS-160. 

19. Assemble the Output Ball Bearing, NAS-159, into the 
Main Housing, NAS-175. Clamp the bearing in place with 
Bearing Retainer Plate, NAS-179, and Flat Head Screws, 
NAS-174. 

20. Remove the Assembly Fixture plate from the roller gear 
assembly by sliding it axially from the unclamped Planet 
Shaft extensions. 

21. Slide the Main Housing and Bearing assembly over the 
Output Shaft Adapter, making sure that the bearing is 
properly seated on the Adapter. Clamp in place with Output 
Shaft, NAS-172, and Flat Head Screws, NAS-174. 

22. Assemble Housing End Plate, NAS-176, and Main Housing 
Gasket, NAS-180, to Main Housing with Main Housing Screws, 
NAS-177, Planet Shaft Washers, NAS-166, and Planet Shaft 
Nuts, NAS-169. 

23. Insert the Input Shaft Seal, NAS-178, into the Housing 
End Plate. 
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WRIST ROLL ROLLER-GEAR DRIVE ASSEMBLY PROCEDURE 
STEEL-PLASTIC DRIVE - ASSEMBLY DRAWING NAS-140AP 

1. Lay the Assembly Fixture, NAS-186, flat on a table. 

2. Place the Sun Roller Gear Assembly, NAS-184, on the 
center post of the Assembly Fixture with the shaft extension 
inserted into the center post hole. 

3. Using Dykem marking compound or equivalent, mark four 
equally spaced tooth spaces on the Sun Gear. Orient these 
four spaces to face the four equally spaced holes in the 
Assembly Fixture. 

4. Highlight the indexed tooth on the large central gear of 
each of four 1st Row Roller Gear Assemblies, NAS-149P. 

5. Radially assemble a 1st Row Roller Gear Assembly with 
the Sun Roller Gear Assembly so that the marked indexed 
tooth goes into a marked tooth space. Index the Assembly 
Fixture on the table so that the shaft extension on the 1st 
Row Roller Gear Assembly can be inserted into an Assembly 
Pin, NAS-185. , 

6. Repeat steps for the remaining three 1st Row Roller Gear 
Assemblies. At this time the Assembly Fixture should be 
resting on the four Assembly Pin heads. 

7. Press fit needle Roller Bearings, NAS-151, into each of 
four 2nd Row Gears, NAS-152P. Check the .8752/. 8747 
diameter hubs for growth due to the bearing press and 
machine to size if necessary. 

8. Assemble a key, NAS-170, two Bearing Races, NAS-164, and 
a Planet Shaft Spacer, NAS-163, onto each of four Planet 
Shafts, NAS-162. 

9. Insert the Planet Shaft assemblies into the 2nd Row 
Gears and assemble these into each of four slots in the 
Assembly Fixture. Make certain that proper gear mesh and 
roller contact is made. Planet Shaft keys must properly fit 
into the key slots. Hold the 2nd Row Gears in place with an 
0-Ring or heavy rubber band stretched over their center 
recesses. It may be necessary to hold the Planet Shafts in 
the Assembly Fixture plate with nuts. 

10. Assemble a Ring Support Washer, NAS-167, onto the top 
of each Planet Shaft assembly. 

11. Assemble the Planet Shaft Ring Support, NAS-165, to the 
Planet Shafts and tighten with Ring Support Nuts, NAS-168. 

12. Assemble two Ring Gear Dowels, NAS-157, and two Ring 
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Gear Dowels, NAS-161, to the Ring Gear, NAS-155. 

13. Assemble the Ring Gear to the four 2nd Row Gears from 
the top. This requires patience and deft maneuvering to 
obtain the proper mesh. The side with the shorter dowels 
should face down. With the Ring Gear in place, remove the 
Planet Shaft Ring Support. 

14. Four 2nd Row Rollers, NAS-154P, can now be assembled on 
the output side. Inward pressure on the roller-gear cluster 
by hand or with a heavy rubber band to compress the Sun-lst 
Row Planet Roller contacts may be necessary in order to be 
able to put the 2nd Row Rollers in place. The Torlon 4203 
rollers are larger in diameter than their steel counterparts 
so the rollers must be compressed even before the Ring 
Rollers are put in place. Reassemble the Planet Shaft Ring 
Support. 

15. Remove the Assembly Fixture plate from the roller gear 
assembly by sliding it axially from the unclamped Planet 
Shaft extensions. Assemble four 2nd Row Rollers on the 
input side. Apply inward pressure to the roller cluster, if 
necessary, to put the rollers in place. 

16. Assemble two Ring Rollers, NAS-156P, to the 2nd Row 
Rollers and Ring Gear taking care to properly align dowels 
with dowel holes. 

17. Assemble two Output Shaft Dowels, NAS-173, to the 
Output Shaft Adapter, NAS-171. 

18. The Output Shaft Adapter, can now be assembled to the 
Ring Roller. Bolt the Adapter in place with Ring Gear 
Bolts, NAS-158, and Ring Gear Nuts, NAS-160. 

19. Assemble the Output Ball Bearing, NAS-159, into the 
Main Housing, NAS-175. Clamp the bearing in place with 
Bearing Retainer Plate, NAS-179, and Flat Head Screws, 
NAS-174 . 

20. Slide the Main Housing and Bearing assembly over the 
Output Shaft Adapter, making sure that the bearing is 
properly seated on the Adapter. Clamp in place with Output 
Shaft, NAS-172, and Flat Head Screws, NAS-174. 

21. Assemble Housing End Plate, NAS-176, and Main Housing 
Gasket, NAS-180, to Main Housing with Main Housing Screws, 
NAS-177, Planet Shaft Washers, NAS-166, and Planet Shaft 
Nuts, NAS-169. 

22. Insert the Input Shaft Seal, NAS-178, into the Housing 
End Plate. 
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HINGE JOINT ROLLER-GEAR DRIVE 


DESIGN 


Specifications for the Hinge-Joint drive were: 


Nominal ratio 
Input torque 
Output speed 
Maximum diameter 


30:1 

28.9 Nm (256 in. lb.) 
120 rpm 

304.8 mm (12 in. ) 


Cluster and Gear Geometry 

A cluster geometry with a somewhat larger toggle angle 
than that used in the Phase I study (ref.l) was chosen in an 
effort to meet the target diameter of 304.8 mm (12 in.). 
Detail calculations of cluster geometry, gear stresses, gear 
geometry and measurement data are given in Appendix B. In 
the section Cluster Geometry , gear diametral pitch, pitch 
diameters, and numbers of teeth, together with nominal 
roller diameters are calculated. In the section Gear 
Stresses , gear face widths necessary to keep tooth bending 
and compressive stresses acceptable are calculated. In the 
section Gear Geometry and Measurement Data , tooth geometries 
necessary for manufacture, and data required for inspection 
of the gears are developed. 

TABLE 5 summarizes gear geometry and inspection data 
for the HINGE-JOINT DRIVE. 


Materials 


Stress conditions in the gears are such that nitrided 
or carburized steels are required for all of the external 
gears. An unhardened alloy steel is adequate for the ring 
gear, Nitralloy 135M with a .005/. 008 in. case of Rc60-63 
was chosen for all four external gears. SAE 4340 steel is 
adequate for the ring gear. Gear material data are 
summarized in TABLE 6. All rollers except the ring rollers 
are made of AMS-6490 vacuum melted M-50 steel through 
hardened to Rc 61-63. The ring rollers are made of AMS-6245 
vacuum melted 9310 steel case carburized with a .030/. 045 
in. case of R^ 5 N 89.5-91 hardness. Bending stresses in the 
ring rollers dictate that a carburized steel with a soft 
core be used rather than a through hardened steel. For 20% 
torque transfer through the rollers (discussed later in the 
section ROLLER SIZING ) the maximum bending stress (at the 
inner fiber) is .15 GPa (22,100 psi) , (ref. 4, p.210). This 
level of reversed stress would make use of a through 
hardened steel risky. 

The most critical aspect of gear fabrication is 
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achievement of accurate timing of the x^ and Yl gears. 
Nitrided gears are not normally machined after nitriding 
because the process does not cause appreciable tooth 
distortions. The risk of small distortions, however, which 
might make assembly difficult or impossible, necessitated 
revisions in the fabrication procedure for the gear. The 
y^ gear was finish cut and nitrided before mounting the x^ 
gear blank. The x^ gear was then rough cut with the teeth 
timed to the y^ gear. Approximately 1 mil of stock was left 
on tooth faces. The x^ gear was then nitrided with the y^ 
gear masked off during nitriding. After nitriding, the x^ 
gear was finish cut, again with teeth timed to the y^ gear. 
Timing accuracies achieved are discussed in the section 
ASSEMBLY. 

Roller Sizing 


As with the WRIST-ROLL DRIVE a number of iterative 
calculations of roller torque fraction, normal load, and 
Hertzian contact were made to determine a feasible level of 
torque that could be carried through the rollers without 
extending roller widths much beyond .187 inches. At a 
torque fraction of .20 with an assumed traction coefficient 
of .06, Hertz stresses are acceptable with line contacts at 
ax-L and y^ x 2 and point contacts at y 2 c . A cross radius of 
30.48 mm (1.2 in.) is used on the ring roller inside 
diameter to produce a crown which assists in assembly. For 
20% torque transfer through the rollers, loads, stresses and 
deformations are as follows: 


Roller Diameter Width Load Max Hertz 1 Normal Approach 1 
mm (in. ) mm (in. ) N ( lbs) Stress mm (in. ) 

GPa (KSI ) 


a 21 . 97 ( . 8649) 3.23 (.127) 

1099(247) 1.28(187) . 0122 (. 00048 ) 

Xl 48.64 (1.9151)3. 18 ( .125) 

y x 18 . 33 ( . 7217 ) 4 . 93 ( . 17 3 ) 

1776(399) 1.38(200) .013(. 00051) 

x 2 91. 65(3. 6083)4. 82( .190) 

y 2 90. 20 (3. 5511) 4. 45(. 175) 

3164(711) 1.58(230) . 0213 (. 00084 ) 


c 238. 12 (9. 3749) 5. 59 ( . 220) 


(1) Ref. 4, p. 516. 


Roller radii for manufacturing were determined by 
adding half the normal approach of a contact pair to each 
roller. The radial bending deflection of the ring roller 
was determined to be .0686 mm (.0027 in.) so its 
manufactured radius was corrected by that amount plus half 
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the Hertzian deformation. Manufacturing diameters and 
drawing numbers for the rollers are shown in TABLE 7. 

With each roller manufactured to its nominal diameter, 
the theoretical diameter over the second row planet rollers 
before assembly of the ring rollers is 238.19 mm (9.3774 
in.) with the ring roller manufactured to 237.97 mm (9.3687 
in.) the nominal radial interference to be overcome at 
assembly is .11 mm (.0044 in.). The crown resulting from a 
30.48 mm (1.2 in.) cross radius on the ring roller is .13 mm 
(.0051 in.) so the ring rollers should be assemblable with 
little or no preheating. 


Drawings 

The Hinge-Joint Drive is defined by assembly drawing 
NAS-300A, and detail drawings NAS-301 through NAS-341 
inclusive. These detail drawings include commercial parts 
required for assembly. The Assembly Fixture is defined by 
drawings NAS-342 and NAS-343. 


ASSEMBLY NOTES 


The first row planet gear and pinion timing errors 
received from the manufacturer were: 


Part 


Error , in. 


S/N 1 
S/N 2 
S/N 3 
S/N 4 


.0005 

.0005 

.0035 

.0005 


Second row planet rollers were assembled with Nos. 1, 
3, 5 and 7 on the input side and Nos. 2, 4, 6 and 8 on the 
output side. 

No problems were encountered at my stage of assembly. 
The ring gear engaged the second row gears without forcing. 
The measurements over the second row rollers averaged 238.20 
mm (9.3780 in.). Ring roller IDs were measured as 237.98 mm 
(9.3692 in.) resulting in an initial diametral interference 
of .22 mm (.0088 in.). Ring rollers were heated to 
approximately 250° F for ease of assembly. 
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HINGE-JOINT ROLLER-GEAR DRIVE ASSEMBLY PROCEDURE 
ASSEMBLY DRAWING NAS-300A 


1. Lay the Assembly Fixture, NAS-343, flat on a table. 

2. Place the Sun Roller Gear Assembly, NAS-301, on the 
center post of the Assembly Fixture with the shaft extension 
inserted into the center post hole. 

3. Using Dykem marking compound or equivalent, mark four 
equally spaced tooth spaces on the Sun Gear. Orient these 
four spaces to face the four equally spaced holes in the 
Assembly Fixture. 

4. Highlight the indexed tooth on the large central gear of 
each of four 1st Row Roller Gear Assemblies, NAS-304. 

5. Radially assemble a 1st Row Roller Gear Assembly with 
the Sun Roller Gear Assembly so that the marked indexed 
tooth goes into a marked tooth space. Index the Assembly 
Fixture on the table so that the shaft extension on the 1st 
Row Roller Gear Assembly can be inserted into an Assembly 
Pin, NAS-342. 

6. Repeat steps for the remaining three 1st Row Roller Gear 
Assemblies. At this time the Assembly Fixture should be 
resting on the four Assembly Pin heads. 

7. Press fit needle Roller Bearings, NAS-325, into each of 
four 2nd Row Gears, NAS-311. 

8. Assemble one 2nd Row Roller, NAS-312, onto each 2nd Row 
Gear with Hex Head Screws #1, NAS-339. 

9. Assemble a key, NAS-324, two Bearing Races, NAS-322, and 
a Planet Shaft Spacer, NAS-321, onto each of four Planet 
Shafts, NAS-319. 

10. Insert the Planet Shaft assemblies into the 2nd Row 
Gears and assemble these into each of four slots in the 
Assembly Fixture. Make certain that proper gear mesh and 
roller contact is made. Planet Shaft keys must properly fit 
into the key slots. The previously assembled 2nd Row 
Rollers should be laying on the side nearest the Assembly 
Fixture plate. It may be necessary to hold the Planet 
Shafts in the Assembly Fixture plate with nuts. 

11. Assemble a Ring Support Washer, NAS-323, onto the top. 
of each Planet Shaft assembly. 

12. Assemble the Planet Shaft Ring Support, NAS-327, to the 
Planet Shafts and tighten with Planet Shaft Nuts, NAS-326. 
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13. Assemble two Ring Gear Dowels #1, NAS-315, and two Ring 
Gear Dowels #2, NAS-316, to the Ring Gear, NAS-313. 

14. Assemble the Ring Gear, to the four 2nd Row Gears from 
the top. This requires patience and deft maneuvering to 
obtain the proper mesh. The side with the shorter dowels 
should face down. With the Ring Gear in place, remove the 
Planet Shaft Ring Support. 

15. The remaining four 2nd Row Rollers can now be assembled 
to the 2nd Row Gears. Reassemble the Planet Shaft Ring 
Support. 

16. Assemble two Ring Rollers, NAS-314, to the 2nd Row 
Rollers and Ring Gear taking care to properly align dowels 
with dowel holes. It may be necessary to heat the Ring 
Rollers to be able to press them over the 2nd Row Rollers. 

17. Assemble two Output Shaft Dowels, NAS-330, to the 
Output Shaft Adapter, NAS-328. 

18. The Output Shaft Adapter can now be assembled to the 
Ring Roller. Bolt the Adapter in place with Ring Gear 
Bolts, NAS-317, and Ring Gear Nuts, NAS-318. 

19. Assemble the Output Ball Bearing, NAS-331, into the 
Main Housing, NAS-334. Clamp the bearing in place with 
Bearing Retainer Plate, NAS-332, and Hex Head Screws, 
NAS-338 . 

20. Remove the Assembly Fixture plate from the roller gear 
assembly by sliding it axially from the unclamped Planet 
Shaft extensions. 

21. Assemble "0" Ring #1, NAS-333, into Output Shaft, 

NAS-329. 

22. Slide the Main Housing and Bearing assembly over the 
Output Shaft Adapter, making sure that the bearing is 
properly seated on the Adapter. Clamp in place with Output 
Shaft and Hex Head Screws #1, NAS-339. 

23. Assemble Housing End Plate, NAS-335, and "0" Ring #2, 
NAS-337, to Main Housing with Hex Head Screws, #2, NAS-340, 
Planet Shaft Washers, NAS-320, Planet Shaft Nuts, NAS-326, 
"0" Rings #3, NAS-341, and Planet Shaft Keys, NAS-324. 

24. Insert the Input Shaft Seal, NAS-336, into the Housing 
End Plate. 
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PITCH YAW JOINT ROLLER-GEAR DRIVE 


DESIGN 


Specifications for the Pitch Yaw Joint drive were: 


Nominal ratio 
Output torque 
Dual input torques 
Maximum size 


3.43:1 

186.5 Nm (1650 in. lb.) 
27.1 Nm (240 in. lb.) 
no larger than ORNL 
LTM Large P/Y unit 


The Pitch Yaw Joint Roller-Gear Drive preliminary 
design was reported in ref. 1. Size constraints dictated 
that it fit into the same 15.24 x 15.24 cm (6 x 6 in.) cross 
section as the ORNL LTM Large P/Y unit. 


Gear Geometry 

Gear calculations were made to establish viable tooth 
design. They are presented in Appendix C with slight 
modifications of geometry factor J as obtained from the 
Gleason Corp. computer run. Gear dimensions, tooth stresses 
and reaction forces are shown in Table 8 . Detailed 
geometries of the Zerol bevel gears obtained from the 
Gleason computer run are shown in Table 9 . 


Roller Geometry 

Spatial constraints limited the width of the input cone 
roller face to approximately 9.525 mm (.375 in.) and the 
transversing bevel roller face to approximately 11.227 mm 
(.442 in.). It was decided to set roller loads so that they 
could transmit 20 percent of the torque with a design 
traction coefficient of 0.06. 


For the input roller set: 

Input torque to each cone roller bevel pinion = 

27.1 Nm (240 in. lb.) 

Cone roller pitch radius = 18.445 mm (.726 in.) 

Cone half angle = 16.26° 

Roller torque = .726 P f n 

For 20 percent torque through rollers and ^u = 0.06, the 
normal force F N is F N = (240 ) ( . 20 ) / ( . 726 ) ( . 06 ) = 1101 lb. 
(4899N) . 
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1101 sin 


The required axial force, F A , is then F A = 

16.26° = 308 lb. ( 1 , 37 IN) . 

For the transversing or output cone roller set: 

Total output torque = 186 Nm (1646 in. lb.) 

Torque through each roller-gear contact = 93 Nm (823 

in. lb.) 

Cone roller pitch radius = 46.83 mm (1.8438 in.) 

Cone half angle = 45° 

Roller torque = 1.8438 yu V 

For 20 percent torque through rollers and p = 0.06, the 
normal force F N is 

F N = (823) ( .20) / (1 .8438) (.06) 

F n = 1488 lb. ( 6 , 621N) 

The required axial force, F A , on the pitch/yaw bevel 
roller is then 

F a = (2) (1488) Sin 45° = 2104 lb. (9,364N) 

Table 10 lists roller dimensions, loads, contact 
stresses, normal approach and drawing sources for the bevel 
rollers . 

Materials 

Stress conditions in the bevel gears dictate that the 
teeth be carburized and hardened, so AMS 6265F (AISI 9310) 
steel was chosen. All gears are carburized to have an 
effective case depth of .030 -.045 in. after finishing. The 
vacuum processed 9310 steel has excellent resistance to 
fatigue pitting, and with a specified core hardness of Rc 
34-40, high strength in bending as well. Because of bending 
stresses as well as compressive stresses in the Hertzian 
contacts, AMS 6265F was also chosen for the bevel rollers. 
The specification for surface hardness, case depth and core 
hardness is the same as for the gears. 

Drawing sources for the gears are given on Table 8 and 
for rollers on Table 10. 

Drawings 

Design of the Pitch/Yaw Roller-Gear Drive is defined by 
assembly drawing NAS-200, and detail drawings NAS-201 
through NAS-240 inclusive. Commercial parts required for 
assembly are indicated by callouts 51 through 83 inclusive 
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on drawing NAS-200. 

Drawings NAS-241 and NAS-242 define the Output Bracket 
and Torque Arms which are used for loading the output. 
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PITCH/ YAW JOINT ROLLER-GEAR DRIVE ASSEMBLY PROCEDURE 
ASSEMBLY DRAWING NAS-200 


As part of the assembly procedure it will be necessary 
to group several parts as "A" or "B" parts, with all "A" 
parts and all "B" parts used together. All such parts are 
to be clearly marked. The following parts will require 
coding as "A" or "B": 


DESIGNATION ON 
DRAWING NAS-200 


DESIGNATION ON 

PART NO. DRAWING NAS-200 PART N0 • 


28 

NAS-205 

30 

NAS-222 

6 

NAS-206 

16 

NAS -2 3 2 

25 

NAS-207 

17 

NAS-230 

7 

NAS-208 

18 

NAS -2 31 

13 

NAS-209 

19 

NAS -2 3 4 

14 

NAS-210 

21 

NAS-229 

8 

NAS-223 

22 

NAS -2 3 5 

27 

NAS-236 

74 

Needle Roller 
Thrust Washer 

37 

NAS -2 3 7 

76 

Pitch Shaft 
Ball Bearings 

73 

Intermediate Gear 
Ball Bearing 

70 

Input Gear 
Ball Bearing 

on NAS-201 

mark 2.250 Dia bores as 

"A" 

and "B" ' 


It will be necessary to measure and record values of 
several dimensions on a number of parts as follows: 


PART NO. 

DIMENSION 

A-SIDE 

VALUE 

B-SIDE 

NAS -2 01 

6.000 

3.000 REF. 

3.004 

6.004 



2.875 

1.4375 REF. 

1.4365 

2.8743 



5.704 REF. 


5.7042 


NAS-205A,B 

1.624 

1.622 


1.622 


.375 

.374 


.374 
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NAS-209A, B 


.336 

.335 

.3365 

.722 

.722 

.722 

.593 

.593 

.5943 

5.812 

5.812 

5.812 


( .004B/L) 


( .004B/L) 


NAS-208A,B 

2.3125 

1A 2.3127 

IB 

2 . 3111 



2A 2.3126 

2B 

2.3116 

NAS-2 10A,B 

5.690 

1A 5.6883 

IB 

5.6866 



2A 5.6876 

2B 

5.6875 




3b 

5.6878 

NAS-20 6A,B 

1.0310 

1A 1.0268 

IB 

1.0300 



2A 1.0281 

2B 

1.0300 




3B 

1.0303 

NAS-207A,B 

2.4375 

2.4415 


2.4425 

NAS-203 

3.034 


3.034 ( .004B/L) 


1.562 


1.5615 


NAS-204 

1.844 

1.8429 

• 

1.8429 

NAS-211 

5.620 


5.621 


NAS -2 3 8 

5.745 


5.746 



.055 


.0548 



.477 


.4768 


NAS-229 

.935 

.932 


.932 

NAS-220 

.094 


. 094 


NAS-226 

.094 


.094 


NAS-202 

1.094 


1.095 


NAS-212 

.100 


.1015 


NAS-235 

.625 

.625 


.625 


1. Grind two Fitted Shims, NAS-236, to suit assembly of two 
sets of one each NAS-205 and NAS-207. Each shim thickness 
is determined as follows: 

Thickness = Value of 1.624 dim. on NAS-205 plus value 
of 1.4375 REF for A side or value of 2.875 dim. minus 
1.4375 REF for B side on NAS-201, minus value of .593 
dim. on NAS-205, minus value of 2.4375 dim. on NAS-207. 
Code mark each set as A and B. 
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2. Make two complete assemblies, A & B, of parts NAS-205, 

NAS-206, NAS-207, NAS-208, NAS-236 from step 1, Socket Head 

Cap Screws (part 62) , dowels (parts 57 and 58) and bearings 
(part 73) . 

3. Determine proper distance D3 between needle thrust 
bearing faces on parts NAS-205A and B at assembly: 

D3 = Value of 2.875 dim. on NAS-201 plus value of 1.624 
dim. minus value of .336 dim. on NAS-205A, plus value 
of 1.624 dim. minus value of .336 dim. on NAS-205B. 
(Nominal value is 5.451") 

4. Grind Thrust Washer, NAS-237 (part 37, Torrington 
TRC-3244) to the following thickness T4: 

T4 = Value of 5.745 dim. on NAS-238 minus D3 minus part 
74 thickness minus .1562". 

5. Grind Spacers, NAS-223 (parts 8) to allow proper axial 
spacing of parts NAS-205. Determine S5A and S5B as follows: 

Measure widths of Inner and Outer Rings of four parts 
76 (543TA bearings) . Nominal values are .281" for 
inner rings and .250" for outer rings. Calculate 
average IR width and average OR width. 

S5A,B = 1.624 dim. minus .336 dim. minus .722 dim. 
for NAS-205A and B. 

Each spacer width should be 

W5A = 1/2 value of 5.620 dim. on NAS-211 minus value of 
1.4375 dim. on NAS-201 minus S5A minus 3/2 IR av minus 
1/2 OR av> 

W5B = 1/2 value of 5.620 dim. on NAS-211 minus value of 
2.875 dim. on NAS-201 plus value of 1.4375 dim. on 
NAS-201 minus S5B minus 3/2 IR AV> minus 1/2 OR AV _ 

(Nominal value of W5 is .260") 

6. Determine thickness of Shims, NAS-222 for proper axial 
spacing of assemblies from Step 2 as follows: 

Measure axial distance from inner race face to outer 
race face on parts 73 (Kaydon bearings) as follows: 

Place each bearing horizontally, resting on inner 
race face. Measure distance to outer race face 
under light thrust load. Each measurement should 
be approximately .375" less the bearing axial 
clearance. Mark bearings A and B. Calculate S6 = 

1.624 dim. minus .375 dim. for NAS-205A and B. 
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Assemble Shims NAS-222 to thicknesses T6 as follows: 

T6A = Value of 3.000 REF dim. on NAS-201 plus value of 
.094 dim. on NAS-226 minus bearing A width minus S6A 
minus 1.4375 REF dim. on NAS-201. 

T6B = Value of 6.000 dim. minus 3.000 REF dim. on 
NAS-201 plus value of .094 dim. on NAS-220 minus 
bearing B width minus S6B minus 2.875 dim. plus 
1.4375 REF dim. on NAS-201. 

(Nominal value of T6 is .032") 

7. The complete assembly of parts on the pitch axis can now 
be made, including the Yaw Shaft, NAS-202 and its Set Screw, 
NAS-224. Before the assemblies from Step 2 can be solidly 
mated with the Pitch Shaft, NAS-211 and Bearing Retainer, 
NAS-225, however, the Input Bevel Pinions, NAS-209, and 
Input Bevel Rollers, NAS-210, must be in place. Otherwise 
parts NAS-205 will interfere with entry of parts NAS-210. 

Assembly on the Pitch Axis will consist of the 
following parts: 


NAS-205 

2 

pcs 

Parts 

62 

Socket Head Screws 

NAS-206 

2 

pcs 

Parts 

57 

Dowels 

NAS-207 

2 

pcs 

Parts 

58 

Dowels 

NAS-208 

2 

pcs 

Part 

74 

Thrust Washer 

NAS-211 

1 

pc 

Parts 

75 

Needle Thrust Bearings 

NAS-225 

1 

pc 

Part 

37 ' 

rhrust Washer 

NAS-202 

1 

pc 

Parts 

73 

2 Kaydon bearings 

NAS-224 

1 

pc 

Parts 

76 

4 Barden bearings 

NAS-236 

2 

pcs 

Parts 

56 

Flat Head Screws 

NAS-223 

2 

pcs 

Parts 

59 

Flat Head Screws 

NAS -2 2 2 

2 

pcs 

Parts 

78 

Transducer 

NAS-220 

1 

pc 

Part 

61 

Nut 

NAS-229 

1 

pc 




NAS-226 

1 

pc 




NAS -2 2 7 

1 

pc 




NAS-228 

1 

pc 





8. Install four Parts 72, Needle Roller Bearings, in place 
in NAS-201. 

9. Install Parts 70 (B 545 ball bearings) on NAS-209A and 

B. Put Parts 69 (Snap Rings) in place and measure the gap 

between bearing inner races and snap ring face. Grind 
NAS-231, 2 pcs, for a no-shake fit of the bearing inner ring 
on NAS-209A and B. 

10. Grind two Spacers, NAS-232 to .093". Install two Parts 
71 (Wave Springs) and parts NAS-232 in NAS-201. 

11. Place NAS-210A and B in NAS-209A and B and install in 
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NAS-201 . 


12. After the Pitch Axis Assembly is solidly in place (Step 

7) , allow parts NAS-209A and B to mesh with NAS-205A and B. 
Without installing parts NAS-233, NAS-234 and Parts 68 

(Belleville Springs) assemble parts NAS-235 with Parts 62 
(socket head cap screws) and Parts 57 (dowels) . Put Parts 
67 (thrust washers) and Parts 66 (needle roller bearings) in 
place. Fit parts NAS-229 over thrust washers and measure 
the gap between parts NAS-229 and NAS-201 for both A and B 
sides. If pinions NAS-209 are solidly meshed with gears 
NAS-205, the gap should represent the zero backlash 
position. Axial withdrawal of pinion NAS-209 should result 
in backlash at the rate of .102 mils for each mil of 
withdrawal ( (Sin 16.26°) x (tan 20°) = .102). Withdraw 
pinion NAS-209 to provide the level of backlash to which the 
teeth were cut as measured by pinion gaging (should be 
between .002 and .004 in.) Grind parts NAS-230 to the 
measured gaps plus the amount of withdrawal. Install parts 
NAS-230, NAS-239, and assemble parts NAS-235 with Parts 82 
(socket head cap screws) . Measure backlash between parts 
NAS-209 and NAS-205 and make appropriate adjustments. Input 
assembly is complete except for installation of parts 
NAS-233, NAS-234, Parts 68 (Belleville Springs) and Parts 65 
(shoulder screws) which will load parts NAS-210 against 
NAS-206. When these parts are loaded, as per the schedule 
on drawing NAS-234, at a later assembly step, it may 
increase backlash between NAS-209 and NAS-205. It may then 
be necessary to adjust the thickness of NAS-230. 

13. Assemble Parts 77 (duplex angular contact bearings) and 
parts NAS-214 and NAS-215 into NAS-203. Measure distance 
S13 from back face of NAS-203 to the face of the bearing. 
Grind NAS-217 to thickness T13 as follows: 

T13 = S13 minus .100 dim. on NAS-212 minus .002 to .004 

(This will allow .002/. 004 clamping gap for the duplex 

bearing pair.) 

14. Complete assembly of NAS-212, NAS-217, Parts 57 

(dowels) and Parts 51 (socket head cap screws) to NAS-203. 

15. Place the assembly from Step 14 with the face of 
NAS-212 supported on a horizontal surface. (Gear teeth on 
NAS-203 are up) . Gently press down on the inner race of the 
upper bearing while turning it until the axial play is taken 
out of the bearing. Measure the distance, S-15, from the 
face of the bearing inner race to the back face of NAS-203. 
(This should be coincident with the upper face of NAS-212) . 

16. Grind NAS-216 to the following width W16P. 

W16P = 3.034 dim. on NAS-203 minus S-15 minus 1.094 
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dim. on NAS-202 


Place NAS-216 on NAS-202 and follow with the assembly 
from Step 14. It may be necessary to freeze NAS-202 with 
dry ice and to warm the assembly from Step 14. Assemble 
Part 35 (locknut) onto NAS-202. 

Measure the backlash between NAS-203 and NAS-207A and B 
with NAS-203 withdrawn from the mesh as much as possible by 
tugging on NAS-212 while the measurement is made. The 
backlash should be set at the level to which the teeth were 
cut as measured by gear gaging (should be between .002 and 
.004 in.). If the backlash needs to be reduced, for each 

mil reduction of backlash remove 3.89 mils from NAS-216 
( 1/ (Sin 45°) (tan 20°) = 3.89) 

W16F = W16P - 3.89 x reduction in backlash 

Reassemble and recheck backlash between NAS-203 and NAS-207A 
and B. Make appropriate adjustments to NAS-216 to achieve 
desired backlash. 

17. Assemble Part 78 (transducer) into NAS-240. It is 
assembled to NAS-212 with Parts 59 (flat head socket head 
cap screws) . 

Yaw assembly is now complete except for installation of 
parts NAS-218, NAS-219, Parts 54 (Belleville Springs) and 

Parts 53 (shoulder screws) which will load part NAS-204 
against NAS-20 8A and B. When these parts are loaded, as per 
the schedule on drawing NAS-219 it may increase the backlash 
between NAS-203 and NAS-207A and B. It may then be 
necessary to adjust the width of NAS-216. 

18. Remove NAS-212 from the assembly in Step 15. 

19. The input rollers NAS-210A and B and the pitch/yaw 

roller NAS-204 can now be loaded against their mating 
rollers. For NAS-210A and B follow the load schedule on 
drawing NAS-234 for grinding that part for use in 

conjunction with NAS-233 and Parts 68 (Belleville Springs) . 
For NAS-204 follow the load schedule on drawing NAS-219 for 
grinding that part for use in conjunction with NAS-218 and 
Parts 54 (Belleville Springs) . 



ASSEMBLY OF PITCH/YAW JOINT DRIVE 


The following dimensional details were accumulated at 
assembly: 

Step 1: 

A side thickness = 1.622 + 1.4365 - .593 - 2.4415 = .024 
B side thickness = 1.622 + 1.4378 - .5943 - 2.4415 = .024 

Step 3; 

D3 = 2.8743 + 1.622 - .335 + 1.622 - .3365 
D3 = 5.4468 

Step 4: 

T4 = 5.746 - 5.4468 - .0615 - .1562 = .0815 


Step 5 : 


Average inner ring width = .2804" 

Average outer ring width = .2497" 

W5A = (5.621/2) - (1.4365 + 1.622 - .722 - .335) 

- 3/2 (.2804) - 1/2 (.2497) 

W5A = .264 

W5B = (5.621/2) - (2.8743 - 1.4365 + 1.622 - .7213 - .3365) 
-3/2 (.2804) - 1/2 (.2497) 

W5B = .2645 


Spacers NAS-233 were made to .260/. 255 

Step 6 : 

Measured dimensions of Kaydon bearings 


Bearing A: 
Bearing B: 

S6A = 1.622 - 
S6B = 1.622 - 
T6A = 3.004 + 
T6B = 3.000 + 


.3726" 

.3713" 

.374 = 1.248 
.374 = 1.248 
.094 - .3726 - 1 
.094 - .3713 - 1 


248 - 1.4365 = 
248 + 1.4365 - 


.0409" 

.8743 = .0369" 


Step 8: 

Before installing needle roller bearings, parts 70, 
into NAS-201, it was noted that the free O.D. of the 
bearings was .005" greater than the bore diameter. A check 
with Torrington revealed that up to .007" interference is 
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permissible for this size bearing. The bearings pressed 
easily into place. The thin wall drawn cup does not behave 
as would a rigid shell. According to Torrington, if the 
radial thickness of the housing (even if it is aluminum) is 
at least equal to that of the bearing, most of the yield 
will take place in the drawn cup. 

Step 9: 

Spacers NAS-231 were ground to approximately .062" to 
provide no shake fits between bearings, parts 70, and 
retaining rings, parts 69, on NAS-209. 

Step 12 i 

It proved to be impractical to try to measure the gap 
between parts NAS-229 and NAS-201 so individual dimensions 
in the stack up were measured to arrive at trial thicknesses 
S 12A, B for shims NAS-230. S 12A,B = 5.812 Dim on NAS-209 
+ .625 Dim on NAS-235 - 5.704 Dim on NAS-201 - .935 Dim on 

NAS-229 + Thrust Needle Bearing Stack (part 66+2 parts 

67). Both the A and B side dimension sets were the same. 
The .935 Dim in NAS-229 less the bearing stack was measured 
as .666 on both A and B. 

Therefore 

S 12A,B = 5.812 + .625 - 5.704 - .666 = .067. 

The A side was assembled with a .067" shim. The input 
pinion and gear mesh felt smooth. For the B side a .067" 
shim resulted in very tight mesh with obvious tooth 
ratcheting. It was gradually increased to .070". At that 
thickness both gear meshes had a similar feel. 

Step 13; 

Distance S 13 was measured to be .1605" 

T 13 = .161 - .101 - .002 

T 13 = .058 

NAS-217 was ground to .058" 

Step 15 : 

S 15 was measured to be 1.555" 

Step 16; 

W16P = 3.034 - 1.095 - 1.555 = .384" 

NAS-216 was ground to .384" 

The assembly from Step 14 went into place without any 
cooling or heating. The mesh of NAS-203 with the two gears 
NAS-207 was smooth. No further adjustment of NAS-216 was 
made . 
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Step 17: 


Washers NAS-219 (8 total) were ground to .064 in. to 
produce 29% compression in Belleville Springs (parts 58 on 
NAS-200) and a total axial force on NAS-204 of 1037 pounds. 
Load vs. compression is given on drawing NAS-219. 

Step 19; 

Washers NAS-234 were ground to .045 in. to produce 35% 
compression in Belleville Springs (parts 68 on NAS-200) and 
a total axial force of 325 pounds on each input roller 
NAS-210. . Load vs. compression is given on drawing NAS-234. 
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DRIVE AND CONTROL SYSTEM FOR PITCH/YAW JOINT 


General Description 


The objective was to design, construct and assemble a 
system which would: (1) drive the joint, (2) input specific 
commands to perform single or multiple defined movements, 

(3) measure relevant input speeds and angular positions, (4) 
measure input torques, (5) measure output angular positions, 
and (6) record all of these data as functions of time for 
use in and analyzing performance of the joint. 

The system measures and records, at 4 millisecond 
intervals (250 HZ), the following variables: 


(1) input speeds, TACH A and TACH B , rpm 

(2) input torques, TORQUE A and TORQUE B , ft lbsf 

(3) motor commands , A and B, volts 

(4) Input Resolver positions, A and B, degrees 

(5) Input Resolver Revolutions, A and B 

(6) Output Pitch Position , degrees 

(7) Output Yaw Position , degrees 

(8) Output Pitch Velocity , rpm 

(9) Output Yaw Velocity , rpm 

(10) Output Desire Pitch position, degrees 

(11) Output Desire Yaw position, degrees. 


The control system is an IBM compatible PC based 
system. Other systems, such as the Macintosh, were 
considered, but the availability of the resolver decoders 
plus the simplicity of the MS-DOS operating system 
(important for real time operation) narrowed the choice to 
an IBM compatible. The system is flexible and can be 
re-programmed for future projects. 

The hardware system is centered around three pieces of 
equipment: the computer, the joint, and an electronics 
board. The computer contains a resolver decoder card and a 
D/A-A/D I/O converter card. The electronics board contains 
the resolver reference signals, the torque sensors' 
reference signal, the torque output signal amplifiers, the 
motor tachometers' voltage divider circuit, and the PWM 
amplifiers for the motor drives. 

The electronics board is a custom board that interfaces 
some of the sensors to the computer. The board is contained 
in a box that is set near the joint. Circuits are patterned 
after those that were proven on the LTM and the ORNL LeRC 
projects. The board has the following functions: 


Motor tachometer maximum output voltage is +63 
volts at maximum rpms. A voltage divider network 
is needed to reduce the voltage to +-10 volts for 
the A/D input. 
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The torque sensors require a +5 and -5 vdc signal 
for their reference signal. The circuit used is 
modeled after the circuit used by the LeRC 
electronics . 

The torque sensors' output signal is very small, 
in the millivolt range. For the signal to be 
useful for the A/D's the signal needs to be 
amplified. Again, this circuit is modeled after 
the amplifiers used on the LeRC project. 

The input and the output resolvers require 
reference drive signal for the primary winding of 
the resolvers. The resolvers operate at two 
different frequencies, therefore two separate 
circuits, one for the input resolver drive and one 
circuit for the output resolver drive, are 
provided. 

The PWM amplifiers are mounted on the circuit 
board. Their control and outputs are wired to the 
board . 

A h — 15 or h — 12 vdc power supply to drive the board 
and a 50 v, 10 amp unregulated power supply for the 
PWM amplifiers are included. 

Drawings 

General arrangement of parts comprising the drive and 
control system is shown on assembly drawing NAS-200A. 
Design of machined parts is defined on detail drawings 
NAS-251 through NAS-266 inclusive. Commercial hardware 
required for assembly are defined by callouts 51 through 78 
inclusive on drawing NAS-200A. 


Electro-Mechanical System Components 

The commercial components of the electro-mechanical 
system are as follows: 


Input Side 

1. Gear motors - Electrocraft (Robbins Myers) 

E652-MGHD, Part No. 652-006-205, 
complete with tachometer function. 

2. Position indicators - Clifton Precision Products 

Brushless Resolver 
Model JSSBH-21-K-1 

3. Torque meters - GSE Inc. Torque Sensor Model 8040. 
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Range, +50 ft lbf. 


4. Brake - Magtrol electromagnetic friction 

brake, Model FB-130-101. 
De-energized torque, 0; energized 
torque, 1.27 Nm (180 oz . in.) 

Output Side 

1. Position indicators - Vernitron Corp. 

Transducer VRP 20-2 


Computer and Electronics Board 

Microlab 386 SX system with: 

SIM Ram Module 256K 

Intel CP 80387-SX Co-Processor 

Toshiba 1.2 MB 5 1/4" Floppy 

Western Digital 1:1 H/F Controller 

386 SX Main Board 

AT I/O Card 

Seagate 40MB 65 ms Hard Disk 
Focus 101 AT Keyboard 
Star XR— 1000 Printer 


Electronics board with: 

ILC Data Device Corporation SDC-36015 resolver 
decoder board (6 channel resolver to digital 
converter) 

Metrabyte DAS-16 A/D-D/A card (16 A/D channels, 
two D/A. channel plus eight I/O digital bits) 
Advanced Motion Controls AMC-500 PWM motor drive 
amplifiers (used in current output mode) 

ILC Data Device Corporation R/D Modules (7 units) 


Wiring schematics for the various electronics board 
circuits are given on Figures 1-11: 


1 . 

Figure 

1 

2. 

Figure 

2 

3. 

Figure 

3 

4. 

Figure 

4 

5. 

Figure 

5 

6. 

Figure 

6 

7. 

Figure 

7 

8. 

Figure 

8 

9. 

Figure 

9 


- Power and Power Control 

- Motor Power and Motor Brake Power 

- Motor Tachometer Signals 

- Torque Sensor Reference Signal 

- Torque Sensor Signal 

- Pitch and Yaw Resolver Reference Signal 

- Motor Shaft Resolver Reference Signal 

- Motor Shaft Resolver Position Signal 

- Pitch and Yaw Resolver Position Signal 
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10. Figure 10 - Pitch, Yaw and Motor Shaft Resolver 

Velocity Signals 

11. Figure 11 - Pitch, Yaw and Motor Resolver Signal 

Power Amplifiers 


Software 


Software for the system is written in Turbo C. The 
basic functions are to accept a commanded input then drive 
the joint to that location, collect and store joint data, 
monitor the joint condition, and shutdown the joint on an 
error. It is designed for easy operation interface and 
tuning of joint parameters. Files NASA l.C through NASA 8.C 
inclusive, NASADATA.H, EXTDATA.H and NASADEF.H comprise the 
system. Hard copies of these files are in Appendix D. 


Operating the Joint 

The operation of the computer control panel is by menus 
and keystrokes. The control of the arm joint is completely 
done from the computer. The following is a guide to the 
operation and control to the computer and the control 
system. Power up: 


1. Turn the computer on and allow the computer to perform 
self-diagnostics. This will take about 90 seconds. 

The printer (if connected) will also self-start. The 
computer is ready when the prompt C> appears. 

2. At the prompt type cd tr . Press enter. 

3. At the prompt type tr , the control screen will appear 
after a few seconds. 

4. Turn on the power switch, the black toggle switch. The 
green light will come on. If the green light is dark, 
check that the power cord is plugged in, the fuses are 
good, or the cable from the switch box to the power box 
is plugged in. 

5. Turn on the motor drive power by pushing the black 
button. The orange light will come on. To turn off 
the motor drive power, push the red button. 
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System Menu 


"R" Restart - will initialize the control 

system. 


"S" Single Command -to move the joint in a single 

motion . 

-computer will ask for the 
following parameters 
-Time time for motion 
-Pitch desired pitch angle 
-Yaw desired yaw angle 

"M" Multiple Command -to move the joint in a path 

of multiple motions. 

-computer will ask for the 
following parameters 
-input motions can be entered 
by hand or from a disk file 
(the disk file is created 
from hand input) . 

-motions the number of motions 
(0-10) in the path 
for each motion enter the 
following 


-Time 

time for that motion 


-Pitch 

desired pitch angle 
that motion 


-Yaw 

desired yaw angle 
that motion 


-save 

after the path is 
entered, the operator 

can 


save the path to disk 

file 


for later use (need a 
name) . 

file 


After the "S" and "M" commands have been completed, the 
path data can be saved to disk for later use. The data is 
collected automatically during the motion. If the answer to 
the question about saving the data is N (no) , the data is 
lost. A file name is required. 


"J" Joystick Command -joint operation with the joystick. 

-the joystick has a deadman and a 
return button. 

-Deadman releasing the deadman 
will lock the motor brakes, 
holding the deadman will release 
the brakes. 

-Return pushing the return 

button (at the rear of the stick) 
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will return control to the main 
menu . 

-Control pitch and yaw motions 
with the joystick. 


"N" Neutral Position -will move the joint to neutral 

position. 

-neutral position is determined 
from the setpoint data file. 

"P" Parameters -will display system data, system 

setpoints, and system gains. 

-will display a short menu. 

-"D" displays system data and 
allows the control of the motor 
brakes . 

-"S" displays system setpoints and 
allows for the change of the 
setpoints. The setpoints 
determine the neutral position, 
high and low position setpoints. 

-"G” displays system control loop 
gains and allows for the change 
of the gain values. The control 
loop only uses the motor velocity 
(motor tachs) , position (pitch and 
yaw resolvers) , and output 
velocity (resolver velocity) . The 
other gains listed are not used 
but the variables have been 
defined . 


When exiting the main control program and if any gain 
or setpoint values have been changed, the computer will ask 
if the gains and setpoints need to be saved. If the 
operator answers yes, the new values are saved. If the 
operator answers no, the new values are lost. During the 
program startup, the gains and setpoints are loaded from a 
disk file. 


"E" -exit the control program. 

-note the motor drive power should 
be off before exiting the program. 


Display 

The program will display the pitch and yaw angles after 
a completed motion. The brake status is displayed. The 
condition window displays the operation, warning, or alarm 
conditions . 
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Data Processing 


Data files are stored in the TR directory and can be 
hardcopied with a print command. Data is printed out in a 
four column format. Values of all sixteen variables are 
stored at 4 millisecond intervals so the volume of data from 
even a fractional second run is formidable. 

In order to facilitate processing the data into 
convenient plots, MATLAB has been included in the software. 
The following procedure is used to make plots. At the 
prompts 

> cd c:\matlab\wja (changes directory) 

> copy c:\tr\"data file name" 

(copies data file into matlab\wja) 

> translat "data file name" (The program translat 

reconfigures the data file so matlab 
can read it) 


> matlab (into matlab) 


> makeplot (matlab command to plot) 

> quit (transfer to DOS directory) 


> 


hardcopy or finecopy torq ) 

tach ) 
motor ) 
resolv ) 

py ) 

pyv ) 


(DOS commands 
to 

print out 
plots) 
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TEST RESULTS 


WRIST-ROLL AND HINGE-JOINT DRIVES 


LINEARITY 

Torque ripple is introduced by transmissions through an 
equivalent variable transmission ratio. For geared drives, 
the average ratio is fixed by the relative numbers of gear 
teeth. While this ratio must be a predictable constant, 
over the course of a cycle the apparent ratio can vary about 
this mean due to machining and assembly imperfections. Such 
variations introduce cyclic accelerations of the input and 
output, producing an apparent "torque ripple". In fact, the 
effect is a position ripple, and the resulting torque ripple 
depends on the dynamics of the drive as well as the dynamics 
of the loads attached to both the input and output. Thus, 
position ripple should be minimized, or, equivalently, drive 
linearity should be maximized to minimize resulting torque 
disturbances. Drive linearity measurements are reported 
here . 

Experimental Procedure 

To measure drive linearity and' backlash, 
high-resolution optical incremental encoders were coupled to 
the input and output shafts of each of the drives. 
Corresponding input vs output rotations were recorded. 

The shaft sensors used were BEI series 143 optical 
incremental encoders, which provided 360,000 counts per 
revolution. Each drive was tested with an encoder at the 
input and at the output. A computer program was written to 
sample the encoder angles and compute a ratio of input to 
output position increments for each 1 degree (1000 counts) 
of output (low-speed) rotation. Drive input was rotated 
slowly by hand during sampling in one direction, thus 
avoiding effects of backlash, mechanical dynamics, and 
sampling rate limitations. Input rotations were applied at 
minimum torque to minimize the influence of drive friction 
and stiffness on the position linearity tests. 

The experimental procedure was evaluated using an 
"ideal" drive with unity ratio, i.e. a solid shaft. The two 
encoders were mounted identically to that of an actual drive 
measurement, and the same drive and sampling procedures were 
used. The equivalent incremental drive ratio was measured 
over each 1 degree of rotation, and the ratio proved to be 
unity within 0.1%, corresponding to plus or minus one 
encoder count. Thus, the measurement technique is believed 
to be accurate to 0.1%. 

Data 


Figure 12 shows the input angle vs output angle of the 
Hinge- Joint drive, measured over one rotation of the output. 
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The drive appears perfectly linear, at least within the 
resolution of the plot. To observe the small deviations 
from linear, the slope of input vs output, or the 
incremental drive ratio, was computed over each one degree 
of output and plotted vs output angle. Since the input vs 
output angles appear perfectly linear, only incremental 
drive ratios are displayed for the Steel Wrist-Roll and 
Plastic Wrist-Roll Drives. 

Figure 13 shows the incremental drive ratio of the 
Steel Wrist-Roll drive measured over each 1 degree of output 
rotation, displayed over one full revolution of the output. 
The average drive ratio is 23.23, and the data shows 
incremental ratio variations as large as 0.5%. The 
experimental accuracy is 0.1%. 

Figure 14 shows the same measurement for the Plastic 
Wrist-Roll drive. The average drive ratio was 23.23. Here, 
the incremental transmission ratio variations are 1.5% with 
a clear periodicity of approximately 33 degrees of output 
rotation. This data was taken before the two failures. 
Linearity after repairs was noticeably worse. 

Figure 15 shows the incremental drive ratio of the 
Hinge-Joint drive. Its average ratio was 29.23. Typically, 
the drive ratio varied by less than 0.3%. However, there 
were four regions within the single revolution of the output 
in which the transmission ratio changed significantly, 
particularly in the region around 100 degrees output. 
Figure 16 displays a zoom-in of this worst-case region. The 
variation includes multiple consistent datapoints, which 
suggests that the variation is not attributable to 
measurement noise. 

Analysis 

For all three drives, linearity was good. The two 
Wrist-Roll drives had a ratio of 23.23, and the ratio of the 
Hinge-Joint drive was 29.23. The plastic Wrist-Roll drive 
had the greatest nonlinearity, with the ratio variations 
occurring periodically at about 1.5% every 33 degrees of 
output. Ratio variations of the two steel drives were 
typically within 0.5%, though the Hinge- Joint drive showed a 
spike of about 1.7% variation over about 3 degrees of output 
rotation. This variation may be attributable to a slip of a 
roller upon gear-tooth contact due to accumulated roller 
creep. 

FRICTION 

In addition to low backlash and high linearity, another 
potential advantage of roller/gear drives is low friction. 
Torque of the three drives was measured as both an unloaded 
speed reducer and as an unloaded speed increaser. For the 
Steel Wrist-Roll drive, tests were conducted running dry, 
then again after adding traction fluid. 

For the plastic Wrist-Roll drive, the friction 
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decreased noticeably with time (about 30%) ; the friction 
data reported was taken after approximately one hour of 
unloaded run-in near the rated speed. During this time, the 
input torque was monitored, and appeared to have stabilized 
at the values shown. Data shown was taken before the drive 
incurred a failure which necessitated repair. 

The Hinge-Joint drive was driven both as a speed 
reducer and a speed increaser using the Steel Wrist-Roll 
drive to increase the motor drive torque. Torque 
measurements, however, were taken directly at the shaft of 
the Hinge-Joint drive. Use of the Wrist-Roll drive to 
increase motor torque, however, reduced the measured range 
of input velocities by a factor of 23. The Hinge-Joint 
drive thus did not experience as many cycles of run-in time 
as the Wrist-Roll drives. Further, all Hinge-Joint drive 
data was collected "dry". 

Experimental Procedure 

For all friction measurements, shaft torques were 
measured using Himmelstein model MCRT 2402T non-contact 
rotating torque transducers with rated 0.1% linearity. Two 
meters were used: a 50 in-lb range meter and a 350 in-lb 
range meter. Himmelstein strain-gauge amplifiers were used 
to produce analog torque signals. The two meters were 
calibrated relative to each other by coupling them in 
series, performing a complete friction test collecting data 
from both sensors, and computing the scale factor which 
produced correspondence of the two outputs. This 
calibration process thus included calibration of the 
analog-to-digital converters and the strain-gauge amplifiers 
as well as the torque meters. 

For each datapoint of the friction measurements, the 
input was driven by a dc servomotor with proportional plus 
integral velocity control. For a complete dataset, the 
motor was commanded to successive velocities in increments 
of 20 rad/ sec from 0 to 180 rad/ sec, then back down in 
increments of -20 rad/sec, through zero to -180 rad/sec, 
then in increments of 20 rad/ sec back to 0 . At each new 
speed, the data was permitted to settle for 10 seconds, then 
data was sampled continuously over 15 seconds and averaged. 

For friction measurements, the strain-guage amplifier 
low-pass filter frequency was set to 1Hz. Filtered analog 
data was sampled by 12-bit analog-to-digital converters at a 
rate of 1 kHz, and averaged over 15,000 samples for each 
datapoint. 

Each resulting datapoint is highlighted on the graphs, 
with connecting lines illustrating the history of data 
collection. 

Data 

Figure 17 shows the steady-state torque required to 
drive the "input" (high-speed shaft) of the Steel Wrist-Roll 
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drive with no load. This data was taken before adding 
traction fluid to the drive. Similarly, Figure 18 is the 
friction driving the Steel Wrist-Roll drive as an unloaded 
speed increaser. The data shows a significant Coulomb 
friction and a lesser viscous (speed-dependent) friction. 
Slopes of the friction curve about the origin should not be 
interpreted as an apparent saturating viscous effect. The 
slopes here are merely a graphical consequence of connecting 
discrete datapoints. In fact, the Coulomb friction effect 
extends down to zero velocity. 

Friction tests on the Steel Wrist-Roll drive were 
repeated after adding traction fluid. The lubricated 
friction data is shown in Figure 19 and Figure 20 as a 
reducer and increaser, respectively. 

Identical tests were performed on the Plastic 
Wrist-Roll drive, after a suitable run-in time. Friction 
data as a speed reducer and as a speed increaser are shown 
in Figure 21 and Figure 22, respectively. 

Friction data for the Hinge-Joint drive was only taken 
over a speed range of -8 to +8 rad/sec, since the Steel 
Wrist-Roll drive was used as a speed reducer to drive it. 
Friction data as a reducer and an increaser is given in 
Figure 23 and Figure 24, respectively. Note that the range 
of input velocities as a speed reducer is severely limited, 
though the same range as a speed increaser corresponds to 
about 60% of the rated top speed. 

Analysis 

The drives exhibit a large Coulomb friction component. 
The Hinge-Joint and Plastic Wrist-Roll drives show virtually 
no viscous effect. The Steel Wrist-Roll drive does show a 
viscous effect. The Plastic Wrist-Roll drive showed 
friction levels comparable to the Steel Wrist-Roll drive, 
though they differ in friction vs speed dependence. The 
reducer friction and increaser friction are roughly the same 
ratio as the speed ratio, though not precisely so. 
Friction/ speed hysteresis (friction depending on history of 
velocity excitation) is noticeable in the steel 
drives, though negligible in the plastic drive. The speed 
hysteresis may be due to variations in internal loading due 
to inertial transients when changing between successive 
steady state velocities. 

INERTIA 

Inertia was measured for the Steel Wrist-Roll drive 
only. Input (high-speed shaft) and output (low-speed) shaft 
inertia were measured separately, though accuracy of the 
input inertia measurement was poor. 

Experimental Procedure 

The Steel Wrist-Roll drive (test drive) was coupled to 
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a dc servomotor through a 50 in-lb reactionless torque 
meter. The servomotor was controlled with acceleration 
feedforward and proportional-plus-derivative feedback to 
produce a smooth, specified sinusoidal motion. Over each 
sinusoid, the torque meter and the drive angle were sampled 
at 1kHz. One hundred of these sinusoids were sampled 
synchronously and averaged together to reduce noise. The 
100-sample average, though, was hardly different from that 
of a single-pass, implying that the noise content was low. 

The torque meter was low-pass filtered in analog at 
100Hz before sampling. To correct the measurements for 
inertia of the couplings and the torque meter itself, the 
same data acquisition routine was run on the system with the 
test drive removed. The inertia of the measurement system 
was thus derived. 

The test drive was driven both as an unloaded speed 
reducer to obtain input inertia and as an unloaded speed 
increaser to obtain output inertia. 

Data 


The measurement system alone (motor, torque meter and 
couplings) was driven sinusoidally with a magnitude of 10 
radians and a frequency of 2 Hz. The apparent inertia seen 
by the torque meter (one coupling and 1/2 of the meter's own 
inertia) was measured to be 0.000255 Kg - m 2 . The same 
amplitude and frequency were imposed with the high-speed 
shaft of the test drive coupled to the system. The apparent 
inertia increased by less than 25%. Thus, the measurement 
of input inertia had poor accuracy, since the inertial load 
was dominated by the inherent inertia of the measurement 
system itself. Nonetheless, the input inertia of the test 
drive could be estimated at 0.00006 Kg - m 2 (600 gm -cm 2 ). 

Measurement of the output inertia was more accurate. 
The low-speed shaft was driven sinusoidally with an 
amplitude of 1.0 radians at a frequency of 2.5Hz, and the 
position and drive torque were sampled at 1kHz over 100 
cycles. The averaged data is shown in Figure 25. 

Analysis 

The data shown in Figure 25 was curve-fit to pure 
sinusoids, resulting in a torque signal of 4.4 N-m 
amplitude, 2.5Hz, leading the position signal by 140 
degrees. If the torque signal were due entirely to inertial 
effects, then it would have led the position signal by 180 
degrees. The actual phase shift implies that the inertial 
effect has a magnitude of 3.35 N-m. In addition, there is 
an apparent viscous effect with a magnitude of 2.85 N-m 
in-phase with the velocity. The chosen excitation produces 
an angular acceleration of 247 rad/sec 2 . Thus, the 
inertial torque of 3.35N-m implies an apparent test drive 
output inertia of 0.0135 Kg - m 2 . The influence of the 
measurement system inertia compared to the true load inertia 
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is less than 2%. 

Ideally, the output inertia should be equal to the 
input inertia times the drive ratio squared. The measured 
input inertia of 0.00006 Kg - m 2 times the drive ratio of 
23.23 squared is 0.033 Kg - m 2 , which is roughly 2.5 times 
greater than the measured output inertia. The discrepancy 
is primarily due to the poor resolution of the input inertia 
measurement. Based on the more trustworthy output inertia 
measurement, the equivalent input inertia should be 0.000025 
Kg - m 2 , or 250 gm - cm 2 . 

Although the input inertia measurement had a relatively 
low accuracy, it should have been more consistent with the 
output inertia. It is possible that nonlinear friction 
terms, which cannot be accounted for in terms of 
phase-shifted sinusoids, influenced the measurements more 
than expected. Thus, while the output inertia has been 
measured more accurately than the input inertia, the derived 
value of the output inertia should not be considered 
precise . 

BACKLASH 

An unusual feature of roller/gear drives is that, 
ideally, they exhibit no backlash. Since the rollers always 
maintain rolling contact, there should be no deadzone 
between input and output angles. 

Experimental Procedure 

This measurement used the same experimental setup as 
used for the tests for LINEARITY. High-resolution encoders 
were coupled to both the input and the output of each 
transmission. The input shaft was rotated by hand forward, 
reverse, forward, and reverse again through an angle 
corresponding to 0.5 degrees of output rotation. The 
encoders were sampled at a high rate, and input and output 
angles were recorded for each 0.050 degrees of output 
rotation. Using the prescribed cyclic input, backlash in 
the drives would appear as a hysteresis in the input vs. 
output angle plots. 

Data 


Input vs. output angle of the Steel Wrist-Roll drive is 
shown in Figure 26. The negative slope is due to the 
arrangement of the encoders in opposition. The measured 
datapoints retrace themselves almost identically; any 
possible hysteresis is smaller then the measurement accuracy 
of 0.001 degrees of output angle. Similar plots are given 
in Figure 27 and Figure 28 for the Plastic Wrist-Roll drive 
and the Hinge-Joint drive, respectively. 
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Analysis 

At least within the accuracy limitations of the 
high-resolution encoders (0.001 degrees), no backlash could 
be observed in either of the steel drives. The plastic 
drives might have exhibited a small hysteresis, but the 
effect is hardly larger than the measurement accuracy. This 
experiment was performed on the drive after it was damaged 
and re-worked. 

STIFFNESS 

Stiffness measurements were made only of the Steel 
Wrist-Roll drive. Stiffness measurements on the plastic 
Wrist-Roll drive were not performed prior to the failure, 
and the stiffness of the Hinge-Joint drive exceeded the 
stiffness of the couplings connecting the transmission input 
to the torque meter. 

Experimental Procedure 

The high-torque shaft of the Steel Wrist-Roll drive was 
held stationary (secured to ground) while the input was 
torqued through the 50 in-lbf reactionless torque meter. 
Torques were applied manually, held steady by observing the 
torque-meter output. The input torque and twist angle were 
sampled in the steady state (static torque balance) at 1kHz 
over 15 seconds, and the mean values were recorded. Eleven 
datapoints were recorded using input torque values of 0, 0.5 
and 1.0 N-m, imposed alternately. 

The same test was repeated on the torque meter and 
coupling alone, with the test drive removed, to isolate the 
influence of the measurement system stiffness. 

Data 


The measurement system exhibited a nonlinear stiffness, 
which increased from a value of 190 N-m/rad at low torques, 
to about 300 N-m/rad at torque levels near the 
transmission's rated maximum input torque, to nearly 400 
N-m/rad at the maximum torque input of the meter. 

With the measurement system in series with the test 
drive, the measured input stiffness was also nonlinear. An 
average stiffness up to 50% of maximum rated torque was 
approximately 30 N-m/rad. A representative (incremental) 
input stiffness for loadings from 50% to 100% of the rated 
torque was 40 N-m/rad. 

A similar experiment on the Hinge-Joint drive yielded 
data which only demonstrated that the transmission stiffness 
was significantly larger than the stiffness of the 
measurement system. 
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Analysis 

Since the measured stiffness with the Steel Wrist-Roll 
drive was an order of magnitude lower than the stiffness of 
the measurement system, the experiment should be valid. 
Thus, the Steel Wrist-Roll drive has an input stiffness of 
30 to 40 N-m/rad (roughly 300 in-lbf/rad) . Its input 
stiffness varies with the applied torque, behaving like a 
stiffening spring. 

The stiffness of the Hinge-Joint drive could not be 
measured. It could only be proven that this transmission 
was significantly stiffer then the measurement system, which 
was approximately 200 N-m/rad. 

EFFICIENCY 

Efficiency as a function of speed and torque was 
measured on the -two Wrist-Roll drives. For the Steel 
Wrist-Roll drive, efficiencies were measured both dry and 
with traction fluid added. Efficiencies were measured up to 
the rated torque, though only up to 60% of the rated speed 
due to equipment limitations. For the Hinge-Joint drive, 
only static measurements were performed. 

Experimental Procedure 

To measure efficiencies of the Wrist-Roll drives, the 
two drives were coupled together at their high-torque shafts 
through a rotating, 350 in-lb range torque meter. The 
high-speed shafts of each drive were driven by dc 
servomotors. The drive under test was coupled to its drive 
motor through a rotating, 50 in-lb range torque meter. All 
devices were coupled using Thomas miniature flexible disc 
couplings, which provide relatively high torsional stiffness 
along the shaft axis and compliance along all five remaining 
degrees of freedom. Figure 29 shows the test setup. 

The high-speed shaft of the drive under test was 
controlled to run at specified speeds from -180 to 180 
rad/sec. As in the friction experiments, each datapoint was 
obtained by controlling the drive speed through a 
proportional-plus-integral speed controller, waiting 10 
seconds for settling after each new speed command, and 
sampling torque and speed data for 15 seconds during 
steady-state conditions. Both torque meters were low-pass 
filtered in analog at 1Hz and digitally sampled at 1kHz to 
obtain a 15,000-point average for each datapoint. 

To produce a desired load torque, the second drive and 
servomotor were controlled in a proportional-plus-integral 
torque feedback loop, based on the measured output torque of 
the drive under test. The controlled torque source achieved 
accurate steady-state torque loads at all input speeds. 

Each dataset was obtained at a fixed "output" 
(low-speed) torque while the "input" (high-speed) velocity 
was incremented through a range of values. As in the 
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friction experiments, the data was collected starting from 
rest, incrementing in steps of 20 rad/sec up to 180 rad/sec, 
then retracing the positive-velocity measurements in speed 
decrements of 20 rad/sec, then continuing through zero down 
to -180 rad/sec, and finally retracing the negative velocity 
measurements in increments of 20 rad/ sec back to rest. 
Individual datapoints are highlighted, showing repeatability 
and/or hysteresis in the measurements. 

Load torques were held constant in each dataset at six 
values in equal increments from 0 to 25 N-m. Note that a 
positive "output load" in combination with a negative "input 
velocity" corresponds to power flow in the "reverse" 
direction. That is, at negative velocities the torque 
source at the low-speed shaft acts as a power source, and 
the velocity controller at the high-speed side acts as a 
controlled brake which sinks power. In this regime, the 
drive may be thought of as acting as a speed increaser 
rather than a speed reducer. This type of measurement is 
somewhat unusual, since drives are seldom measured with 
active torque sources. Additional measurements were 
performed to validate the procedure, described further 
below. 

Figure 30 shows the measured output torque vs input 
velocity for each of the datapoints obtained. This plot 
documents the effectiveness of the controlled velocity and 
torque sources. Each line includes 37 datapoints, each 
consisting of 15,000 torque and velocity samples at steady 
states. Typically, only 19 datapoints per line can be 
observed, since the controlled states retrace themselves 
almost identically (with some exceptions at zero velocity) . 
Figure 30 is representative of the states sampled for each 
of the Wrist-Roll drive cases: Steel running dry; Steel 
with traction fluid and Plastic. 

Figure 31 shows the output power (positive for power 
out of the low-speed shaft, negative for power into the 
low-speed shaft) corresponding to the states of Figure 30. 
Since these controlled power flows are typical for all 
Wrist-Roll drive measurements, the plots are not repeated 
for each case. 

Dynamic efficiency of the Hinge-Joint drive was not 
measured. Instead, the output (high) torque was measured 
using a 10,000 in-lb Himmelstein reaction torque meter, 
model 2060. The input (low) torque was excited using the 
Steel Wrist-Roll drive coupled through the 350 in-lb 
Himmelstein reactionless torque meter. The input to the 
Steel Wrist-Roll drive was driven by a dc servomotor which 
was controlled in a proportional-plus-integral torque 
feedback loop with respect to the measured input torque of 
the Hinge-Joint drive. Thus, the Steel Wrist-Roll drive 
acted as a torque source to the Hinge-Joint drive. The test 
setup is shown in Figure 32. 

The controlled torque source was stepped through three 
cycles of increasing and decreasing input torques, ranging 
from -25 N-m to +25 N-m in steps of 5 N-m. For each step. 
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the torque source was slowly ramped between successive 
torque commands in order to avoid torque "overshoot". Thus, 
the torque data was collected with a known history of 
loading to preserve hysteresis information. In the three 
cycles of torque loading, 61 datapoints were recorded. As a 
quasi-static torque source, the control over input torque 
was not as precise as under dynamic conditions. 
Nonetheless, the loading was smooth and reasonably 
reproducible, as demonstrated in the data plots. 

The torque controller was given 15 seconds to settle 
between successive torque commands, then data was sampled at 
1kHz over 10 seconds and averaged. The 10,000 in-lb 
reaction torque meter at the output was analog low-pass 
filtered at 1Hz . The 350 in-lb reactionless torque meter at 
the input was analog low-pass filtered at 100Hz. This 
filter frequency was required to obtain adequate bandwidth 
of the torque source feedback controller. The strain-guage 
amplifier used was not matched (recalibrated) to the 10,000 
in-lb reaction torque transducer. Thus, the absolute 
accuracy of the output torque data is not guaranteed to be 
as precise as the input torque data. However, the 0.1% 
linearity specification still applies, so differential 
measurements can be compared with high accuracy. 

Data 


Each of the dataplots for the Wrist-Roll drive cases 
include 222 datapoints, each of which consists of a 
15,000-sample average under steady-state conditions. Each 
datapoint is marked, and lines are drawn between successive 
samples, illustrating the history of the data collection and 
possible hysteresis. Measurements at zero speed are 
accurate, though they show less reproducibility due to 
static friction. Efficiency plots do not include the 
zero-velocity datapoints, as efficiency is undefined at zero 
speed. 

Since both speed and output torque are controlled (as 
shown in Figure 30) , characterization is completed by a 
measurement of the corresponding input torques. Figure 33 
shows the input torques measured for the Steel Wrist-Roll 
drive running dry. Two datapoints on this plot, 
corresponding to a load of 17.3 N-m and speeds of -160 and 
-180 rad/sec, were inadvertently recorded at load torques 
slightly lower than the desired 17.3 N-m. The efficiencies 
corresponding to these states have been corrected for the 
true loading conditions. The input power corresponding to 
Figure 33 is shown in Figure 34. Note that the direction of 
power flow at negative velocities is negative, corresponding 
to the velocity source acting as a brake. Efficiency for 
the Steel Wrist-Roll drive, running dry, is shown in Figure 
35. In this and subsequent efficiency plots, the efficiency 
is computed as the ratio of power extracted from the 
transmission to the power delivered to the transmission. 
For positive velocities, the efficiency is the low-speed 
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power over the high-speed power, while for negative 
velocities the efficiency is the high-speed power over the 
low-speed power. The slope of the efficiency curves through 
zero velocity is a graphical consequence of connecting 
successive datapoints, and it should not be interpreted as a 
valid efficiency derivative near zero velocity. 

Efficiency measurements were repeated for the Steel 
Wrist-Roll drive after adding traction fluid. The resulting 
input (high-speed) torque, input power, and efficiency are 
shown in Figure 36, Figure 37 and Figure 38, respectively. 

During efficiency measurements on the Plastic 
Wrist-Roll drive, two failures occurred. At higher torques, 
the "sun" gear broke its Loctite bond on the input 
(high-speed) drive shaft. The gear was subsequently pinned 
in place. On the second efficiency measurement attempt, an 
internal locknut came loose, damaging gear teeth and 
rollers. Repairs were made with available replacement 
parts, but a noticeable distortion remained in the re-worked 
drive. All efficiency measurements reported on the Plastic 
Wrist-Roll drive were obtained from the re-worked unit. 

Input torques and input power for the Plastic 
Wrist-Roll drive are shown in Figure 39 and Figure 40, 
respectively. Note from Figure 40 it can be seen that the 
lowest two output torques (4.2 and 8.3 N-m) were not 
sufficient to operate the drive as a speed increaser. To 
obtain measurements under these loading conditions, the 
controlled velocity source at the high-speed shaft had to 
supply power to the drive in addition to the power supplied 
by the torque source at the low-speed shaft. Thus, 
efficiencies as a speed increaser at these torques are 
actually negative, since the drive absorbs power from both 
ports . 

Efficiency of the Plastic Wrist-Roll drive is shown in 
Figure 41. Data corresponding to the lowest 2 loading 
conditions has not been displayed, since these loads include 
negative efficiencies. 

Dynamic efficiency of the Hinge-Joint drive was not 
measured. Only reaction torques were obtained. Figure 42 
shows the set of input torques applied to the Hinge-Joint 
drive. This data is displayed vs the angle of the drive 
motor at the input of the Steel Wrist-Roll drive, which was 
used to amplify torque inputs to drive the Hinge- Joint 
input. In applying plus and minus 25 N-m of torque to the 
Hinge-Joint drive, the Steel Wrist-Roll drive required an 
input rotation in excess of one full revolution. Stiffness 
measurements showed that this wind-up is primarily due to 
the reflected compliance of the mechanical couplings driving 
the Hinge-Joint input shaft. Figure 43 shows the 
Hinge-Joint drive output torques corresponding to the inputs 
of Figure 42. Note in both cases that 61 datapoints taken 
over three cycles of loading are highly reproducible, except 
for the initial loading application. The clear hysteresis 
is not attributable to the instrumentation, nor to any 
friction effects outside of the Hinge-Joint drive. 
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Input torque vs output torque is plotted in Figure 44. 
The plot superimposes all three cycles of loading, which are 
virtually identical. 

Efficiency Measurement Validation 

A surprising result of the Steel Wrist-Roll drive 
efficiency measurements is that this efficiency is actually 
higher using the transmission as a speed increaser (power 
flow into the low-speed shaft) than as a speed reducer 
(power flow into the high-speed shaft) . A potential cause 
of the unexpectedly high reverse efficiency is the unusual 
measurement technique, in which the low-speed shaft is 
driven by an active torque source. Ordinarily, the "load" 
torque is exclusively passive, such as a friction brake. In 
the present system, a controlled torque is maintained either 
as a power source or as a power sink. 

To test the validity of the measurement technique, the 
procedure was inverted: the low-speed shaft was driven with 
a velocity source, and the high speed shaft was driven with 
a torque source. A complete dataset was obtained for the 
lubricated Steel Wrist-Roll drive in this reverse test mode. 

Figure 45 shows the measured input torques at 
velocities ranging from -160 rad/sec to +160 rad/sec.- The 
corresponding output torques are shown in Figure 46. Figure 
47 and Figure 48 show the input and output power, 
respectively. Figure 49 shows the resulting efficiency 
plot. 

Figure 49 should not be identical to Figure 38, since 
the individual datasets were taken under different loading 
conditions (controlled high-speed torques vs controlled 
low-speed torques, respectively). Nonetheless, the two 
graphs are quite similar, and clearly support the evidence 
that the Steel Wrist-Roll drive is more efficient as a speed 
increaser . 

Analysis 

The most notable feature of the efficiency measurements 
is that the Steel Wrist-Roll drive was more efficient as a 
speed increaser than as a speed reducer. More precisely, 
power transfer was more efficient when power flowed from the 
low-speed port to the high-speed port. The Steel Wrist-Roll 
drive was most efficient at the highest torque loads and the 
lowest speeds. Decrease in efficiency with increasing 
speeds is consistent with the observed speed-dependent 
frictional losses. High-efficiency as a speed increaser was 
observed in both the lubricated and unlubricated state, 
whether excited by a torque source or by a velocity source. 

Another interesting feature of the efficiency 
measurements of the Steel Wrist-Roll drive is that it 
exhibited higher efficiencies when lubricated than when run 
dry. This indicates that lubrication was effective and that 
viscous losses were not significant. 
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Efficiency measurements on the Plastic Wrist-Roll drive 
were affected by the two failures which occurred during 
testing. Nonetheless, the efficiencies at higher loads 
appears flat as a function of velocity. This behavior is 
consistent with the input and output friction measurements 
performed prior to the failures, in which the friction 
appeared entirely Coulomb-like, with no observable speed 
dependence . 

Dynamic efficiency measurements were not performed on 
the Hinge-Joint drive. The quasi-static measurements showed 
a torque hysteresis of approximately 30 N-m of output 
torque. This torque loss is higher than the measured output 
friction (driven as an unloaded speed increaser) and higher 
than the reflected measured input friction (driven as an 
unloaded speed increaser) . However, the torque loss is less 
than the combined output friction plus reflected input 
friction. 

Since the measured friction curves of the Hinge-Joint 
drive are essentially flat (Coulomb-like) , the efficiency of 
this drive may be expected to be flat vs velocity. At the 
rated full torque of 820 N-m, a loss of 30 N-m would result 
in a projected efficiency of 96%. 

PITCH/YAW JOINT DRIVE 


STIFFNESS 

Experimental Procedure 

Static stiffness tests were conducted by locking the 
inputs and measuring deflections of the output load arms 
under various loads. Figure 50 shows the test setup. 
Dual load arms were used to apply torques about the pitch 
axis, and a single load arm was used to apply torques about 
the yaw axis. 

The inputs were locked by first removing the 
torque meters. A length of 3/8 inch square (9.52 mm square) 
steel rod with a coupling silver soldered to one end was 
substituted for each torque meter. When in place no 
backlash could be detected in either rod between it and its 
connection to the drive. The two rods were then locked to 
each other by placing two lengths of heavy angle iron at 
right angles to the axes of the rods. Sturdy C-clamps 
locked the angle irons to the rods . 

A .0001 in/division (.00254 mm/div) dial indicator was 
clamped to the frame of the drive with the indicator point 
contacting the load arm at 4.687 in (119mm) from the drive 
axis. For torque about the pitch axis, each load arm 
weighs 6.56 pounds (2.98 Kg) with a center of gravity 16.5 
inches (419.1 mm) from the mounting axis. The crossbar 
weighs 1.156 pounds (.525 Kg) and acts at 33 inches (838.2 
mm) from the axis. The torque about the pitch axis is 
therefore 
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T p = [ 2 (16.5) (6.563) + 33 (W+1.156) ] cos 0 

where 0 is the angle to the horizontal made by the load 
arms. For these tests 0p = 4.66°. 

Tp = 253.89 + 32.89 W in lbs (W in lbs) 

Tp = 28.69 + 0.835 W Nm (W in N) 

The tare torque at zero deflection (arms in place) is 
253.89 in lbs (28.69 Nm) . 

The angular deflection about the pitch axis is 

0p = Dp 

4.687 cos 4.66° 


0 P 




4.672 


rad 


where Dp is the dial indicator reading. 

The torsional stiffness about the pitch axis is 
Kg? = T p - 253.89 

0p 

K ©p = 32.89 W 

0p 

In a similar fashion, use of a single load arm to apply 
torque about the yaw axis results in 

Ty = [ (16.5) (6.653) + (W +.969) (33) ] cos jz5 cos © 

where 0 is the angle between the yaw axis and a true 
horizontal. For these tests 0 = 5.87° and 0 = 5.82° 

Therefore 

Ty = 138.8 + 32.659 W in lbs (W in lbs) 

Ty = 15.689 + .830 W Nm (W in N) 

The tare torque at zero deflection is 138.8 in lbs 
(15.69 Nm) . 

In applying torques about the yaw axis there is also a 
torque about the pitch axis 

T p ' = (6.563 + W +.969) (3.625) cos 0 
Tp'= 27.163 + 3.606 W in lbs (W in lbs) 

T p ' = 3.07 + .0916 W Nm (W in N) 

The tare torque at zero deflection is 27.163 in lbs 
(3.07 Nm) . 
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The previously derived pitch axis stiffness, together 
with the torque about the pitch axis, must be taken account 
of in calculating stiffness about the yaw axis. 


©Y — Dv ©d (3.625 cos 5.82^) 
4.687 cos 5.87° 


©v — Dv 3.810 (3.606 W/ K 
4.662 


Kqy — T y 138.8 

or 

K 0Y = 32.659 W 
© Y 

Data 


Measured deflections at various loads about the pitch 
axis are shown in TABLE 11, along with calculated values of 
0p and Kqp . Measured deflections at various loads about the 
yaw axis are shown in TABLE 12, along with calculated values 
of ©y and A value of K Qp = 137,450 as determined from 
the pitch axis data was used calculate Kq Y . 

Analysis 

Data of load vs. angular deflection are shown plotted 
in Figure 51. The pitch axis data are fairly linear over 
the load range investigated and indicate a torsional 
stiffness of approximately 137,000 in lb/rad (15,490 
Nm/rad) . The yaw axis data are irregular, indicating 
decreasing stiffness with increasing load. This is not 
likely real, so the methodology of accounting for 
deflections about the pitch axis probably has deficiencies. 
The pitch axis data can probably be accepted as a reasonable 
value for the joint about either the pitch or yaw axis. 

It is interesting to compare these results with the 
theoretical stiffness of the gear train. At the rated input 
torques of 240 in lb (27.2 Nm) we have the following: 


1 . First Stage 

Mean P.D. of pinion = 1.6567 in (42.08 mm) 
Mean P.D. of gear = 5.68 in (144.3 mm) 

Fip = 289.8 lbs (1290N) tangential 

F n = 308 lbs (1371N) normal 

Fg = 105.5 lbs (469. 5N) separating 
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2 . Second Stage 

Mean P.D. of gears = 2.88 in (73.15 mm) 

F t = 571.5 lbs (2543N) tangential 
F n = 608.8 lbs (2709N) normal 
Fg = 208 lbs (926N) separating 

From ref. 5, 

Tooth deflection 

Y t = 4.85 F m 
E f 

2 Y t = 9.70 F m 
E f 

Compliance 

C = 2 Yrri rad/in lb 

F T r 2 

First Stage: 

C X = (9.70) (308) . 

(30x10° ) (.31) (289.8) (1.6567/2) 2 

C^ = 8.0776xl0“ 7 rad/in lb 

Second Stage: 

C 2 = (9.70) (608) n 

( 30xl0 6 ) (.5) (571.5) ( 2 . 88/2 ) 2 

rad/in lb 


c 2 


3 .3177xl0“ 7 
rad/in lb 
Kip = 2. 5x10° in lb/rad 

Since there are two inputs in parallel the theoretical 
stiffness of the entire gear set should be 

2Kp = 5xl0 8 in lb/rad 

The roller train would be expected to have a torsional 
stiffness comparable to that of the gear train. Since the 
rollers act in parallel with the gears, the stiffness of the 


C 2 

Overall 

Cp 


= 3 . 3177xl0 -7 

= Ci + 

(3.4286) 2 
= 6.871xl0 -8 + 


Cp 

Cp = 4.0048x10 


-7 
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roller-gear train should be greater than that of the gears 
alone . 

Comparison of the theoretical gear set stiffness with 
the measured system stiffness shows that about 97 percent of 
the compliance arises from the multitude of spring elements, 
other than rollers and gears, that comprise the system. The 
sequence of spring elements from input to output is 

1. Torque meter shaft 

2. Key connection with NAS-235 

3. Dowel pin and bolt connection to input pinion 
NAS-209 


4. Input pinion needle bearings 

5. Housing NAS-201 

6 . Input pinion 

7. Input pinion to gear NAS-205 tooth connection 

8. Gear NAS-205 Kaydon ball bearing 

9. Housing NAS-201 

10. Gear NAS-205 

11. Dowel pin and bolt connection to gear 
NAS -2 07 

12. Barden torque tube bearings 

13. Pitch shaft NAS-238 

14. Gear NAS-207 to gear NAS-203 tooth connection 

15. Gear NAS-203 angular contact bearings 

16. Yaw shaft NAS-202 


The "soft" elements in this sequence are the frame, 
NAS-201, and the various bearings. The interaction of the 
elements is complex and not amenable to analysis. To 
appreciably increase torsional stiffness the housing and 
various bearings would have to be made significantly 
heavier. 


CONTROL SYSTEM AND JOINT PERFORMANCE 
Experimental Procedure 

Generally, single motion commands to execute a simple 
change in pitch or yaw were inputted to the system to 
evaluate system performance and response of the joint. 
Figure 52 illustrates schematically the loading system which 
consists of a yoke and two load arms. The load arms can be 
bolted to the yoke in either the forward or rearward 
position. The joint was operated at four load levels 
ranging from 0 (yoke only, arms off) to 100.73 ft lbs output 
torque (about 75% of full load rating) . Inertia effects 
became very troublesome at higher loads, so data was not 
taken at full rating. Table 13 is a tabulation of the data 
files; the type of maneuver, initial and final pitch and yaw 
positions, and load data are listed. 

As stated earlier, the data system operates at 250 HZ, 
recording values of fourteen variables at .004 second 
intervals. Data files can be printed in tabular form but, 
because of the huge volume of data generated in runs of only 
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a fraction of a second, they are not readily amenable to 
analysis without a plotter routine. To facilitate data 
analysis MATLAB was incorporated into the software system. 
Data files are translated into a format readable by MATLAB 
and then plotted exactly as read, or filtered to smooth out 
noise and irregularities arising from limits in instrument 
accuracy. Unless otherwise stated on a figure a value of 11 
was used to smooth data. This means that each data point 
represents the arithmetic average of the five previous 
points, the point in question and the five succeeding 
points. Motor Command and Tach (motor speed) data were 
filtered to remove electronic noise. Data from Input 
Resolvers and Output Pitch and Yaw Position are presented 
unfiltered because the readouts are smooth within the 
accuracy of the instruments (20 minutes of arc for the input 
resolvers and 75 seconds of arc for the pitch and yaw 
resolvers) . Torque data are filtered because of a ripple in 
the A side input (to be discussed later) . Pitch and Yaw 
Velocity data are filtered to reduce irregularities which 
are magnified when slopes are calculated from position data 
at .004 second intervals. Changes in position at successive 
samples are on the order of 10 minutes of arc while resolver 
accuracy is on the order' of 1.25 minutes of arc or 12.5 
percent of the measurement difference. 

Data and Analysis 

Figures 53-61 illustrate data from a 20° pitch lift 
(Data 76) , a 20° pitch drop (Data 77) and a 30° yaw swing 
(Data 78) , each at essentially zero load. Motor Commands 
for the two pitch moves are shown in Figure 53. On each of 
the data plots of two variables, the first is represented by 
the solid line and the second by the dashed line. On four 

variable plots (Desire and Actual Pitch and Yaw, for 

example) the hierarchy is: 

Desire Pitch - Solid line 

Actual Pitch - Dashed line 

Desire Yaw - Dot-dash line 

Actual Yaw - Dotted line. 

Full voltage for the Motor Command is +10 volts. For 
the pitch moves the system response time to reach full 
voltage (Figure 53) was .08 seconds and for the yaw move 
(Figure 59a) was .057 seconds. Duration of the full Motor 
Command voltage was 0.4 seconds for the 20° pitch moves and 

0.65 seconds for the yaw move. Figures 54 and 59b 

illustrate the Tachs (motor speed patterns) for the pitch 
moves and the yaw move, respectively. Time to reach maximum 
motor speed was 0.16 seconds. Duration of maximum motor 
speed was 0.4 seconds for the pitch moves and 0.58 seconds 
for the yaw move. Note, for the pitch moves, the opposite 
sense of the Motor Commands and the Tachs (Figures 53 and 
54) . For a pure pitch move input rotations are in the 
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opposite sense. In contrast inputs are in the same sense 
for a pure yaw move (Figure 59) . For all three moves 
maximum motor speed approaches 2000 rpm. This was found to 
be true for all operations of the joint except when the 
output torque approaches full rating. 

Figure 55 illustrates input shaft positions for the two 
pitch moves, as measured by the input resolvers. The 
absolute values of resolver angles, and whether or not the 
two curves approach or diverge for a particular move, have 
no meaning. Input resolver positions at the beginning of a 
move are random. For a pitch move they must approach or 
diverge, however. For these two cases each resolver moves 
approximately (20 ) (3 . 4286) =68 . 57° , where 3.4286 is the 

reduction ratio of the joint. In contrast, for a yaw move 
the input resolvers move together, as shown in Figure 60a. 
For a 30° yaw move, each resolver should move approximately 
(30) (3 . 4286) =102 . 9°. Close examination of Figure 60a shows 
that resolver A moved 113° and resolver B 92°, indicating 
some asymmetry in control for a pure yaw move. For all 
three moves, the moves are smooth. Any high frequency 
variations in motion are less than the accuracy of the 
resolvers. 

Figure 56 shows the Desired and Actual Pitch and Yaw 
for the two pitch moves and Figure 60b the same data for the 
yaw move. "Desire Pitch" and "Desire Yaw" are 
representative of an ideal system with zero response time 
operating at maximum speed. Actually the curves of Figure 
56 are compatible with the system's capabilities but Figure 
60b is overly optimistic. At a maximum achievable motor 
speed of 2000 rpm the angular speed of either the pitch axis 
or yaw axis would be 

(2000) ( \ ) = 6.48 rpm 

90 3.4286 

(90 is the gear box ratio, and 3.4286 is the 

joint ratio) 

Then a 20° pitch move should be executable in 

( 2 0 ..) ( — 1 — ) (60) = 0.514 seconds 

360 6.48 1 

Figure 56 indicates this and the system response is 
excellent, with a lag time of 0.1 seconds. 

For a 30° yaw move a realistic execution time would be 
0.771 seconds. The "Desire Yaw" curve on Figure 60b is too 
optimistic. The joint executes the yaw move in 0.88 seconds 
which is what can be expected with a servo lag time of 0.1 
seconds. 

Pitch and Yaw Velocities as calculated from slopes of 
the position curves are shown in Figure 57 for the two pitch 
moves, and on Figure 61b for the yaw move. All three curve 
sets indicate an angular velocity of 6.5 to 6.7 rpm for the 
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axis in motion, with a ripple of approximately + 2.2 percent. 
The frequency of the velocity ripple is approximately 37.5 
cycles/sec or 2250 cycles/minute. This is not related to 
any mechanical frequency in the joint itself, but it is 
fairly close to the number of data samples ( 27) per 
revolution of the moving axis. Considering that the pitch 
and yaw resolver inaccuracies can be as high as 12 percent 
of the magnitude of the movement from point to point, much 
of the ripple may be noise. 

Torque data are shown for the two pitch moves on Figure 
58 and for the yaw move on Figure 61a. The B input torque 
curve is smooth but the A input curve shows a definite 
ripple. The frequency for the two pitch moves on Figure 58 
is 75 cycles/sec and that for the yaw move on Figure 61a is 
37 cycles/sec. Again, neither of these frequencies is 
relatable to any mechanical frequency in the joint. When 
the A side input ripple was first noted the joint was 
partially disassembled to check the input pinion-gear 
setting. The A side shim set was originally .067 in. and 
the B side .070 inches. A .004 in. shim was added to the A 
side assembly. This increased the backlash approximately 
.001 in. but made no difference in the pattern or magnitude 
of the ripple. The significance of this will be discussed 
more in the discussion of efficiency. 

The high values of torque at startup when the joint is 
accelerating up to speed are the result of inertia. Even 
the relatively low inertia of the joint components and the 
yoke without the load arms or any weights attached (Figure 
52) requires initial torques on the order of 12 to 16 ft lbs 
(Figures 58 and 61a) to accelerate the mass up to speed. In 
other runs at high levels of output torque load, input 
torques of up to 35 ft lbs were recorded. With inertia 
present in the joint components and loading system, only the 
torque values in the constant speed region of each run are 
amenable to analysis. 

Note the relative differences and magnitudes of the two 
input torques in the region between sample numbers 50 and 
130 on Figure 58 a and b. For the pitch lift (Figure 58a) 
the joint is doing work and the tare 'torques are 
approximately +1.1 ft lbs. For the pitch drop (Figure 58b) 
the small torque of the yoke does work on the joint and the 
tare torques resisting the drop are +0.16 ft lbs. 

BACKLASH AND LINEARITY 

When the static stiffness setup was in place, backlash 
measurements were made with dial indicators placed against 
output members. The inputs were effectively locked with the 
arrangement discussed in the section on STIFFNESS. No 
backlash could be discerned through the roller-gear trains 
from the two inputs to the output. 

To investigate linearity a series of multiple runs was 
made (data files 79-83, TABLE 13). These consisted of three 
dual moves in pitch (a pitch drop followed by a pitch lift) 
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at three load levels, a dual move in yaw (a swing followed 
by a return) and a quadrille move (a yaw swing followed by a 
pitch drop followed by a yaw swing back and a pitch lift) . 
Data from these moves are plotted in Figures 62 through 74. 

In the regions of constant motor speed, for all of 
these moves, the filtered velocity of the moving axis 
(whether pitch or yaw) indicates an approximate cyclic 
variation of + 2 percent (Figures 63b, 65b, 67b, 69b and 
71b. A pitch or yaw shaft angular velocity of 6.5 rpm 
represents a change in position of approximately 9.4 minutes 
of arc each .004 seconds (one sampling interval) . The 
accuracy of the pitch and yaw resolvers is 1.25 minutes of 
arc or 12.5 percent of measurement magnitude. Possible 
inaccuracies in measurement, therefore, exceed the 
measurement magnitude so the cyclic fluctuation may or may 
not be real. Its frequency ( 37 cycles/sec) cannot be 
related to any obvious physical characteristic of the P/Y 
joint. 

In regions of rapid acceleration or deceleration (at 
the beginning, center portion and end of each dual move) 
inertia effects predominate. This is more and more apparent 
as output torque (and thus load system inertia) increases. 
Figures 63b (zero load) , 65b (17.96 ft lbs torque) and 67b 
(60.44 ft lbs torque) show an increasing irregularity in 
velocity profile. The fluctuations in velocity may be a 
feedback from the torque loading system. A relatively 
undamped high inertia loading system could account for, at 
least in part, for the observed velocity profiles. The 
increasing irregularity of input torques with increasing 
load for the three dual pitch moves. Figures 72a, 73a and 
73b, indicate graphically that the loading system 
characteristics influence behavior of the joint. 

Figures 70 and 71 indicate that the joint operates 
smoothly through a four part maneuver. Velocity 
fluctuations are very similar in the pitch and yaw changes 
(Figure 71b) . For this quadrille maneuver with zero load, 
tare torque is greatest for the pitch lift move, midway for 
the two yaw swings and least for- the pitch drop move (Figure 
74) . 

It is apparent from these results that a more 
meaningful assessment of joint linearity would require 
further work with a low (or preferably zero) inertia damped 
loading system and more precise resolvers or encoders. 

EFFICIENCY 

For the Pitch/Yaw Joint efficiency can be defined as 

ty = [ Input Power - Output Power ] jqq 

Input Power 
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Input Power = T A £0 A + T B ^ B 

where T A and T B are input torques and 

6<-> a and &-> B are input angular velocities 


From the kinematics of the joint 


^ PITCH - 60 P “ 




2R 

60 YAW = ^ Y = 

^A- + - 



2R 


R, the reduction ratio, is 3.4286 

when torques T p and T y are applied to the 
output of the joint, then 

Output Power = T p A - ^ B ) + T y ( f^A 

2R 2R 

These relationships are used to calculate efficiency 
from known values of T p , Ty and R, and measured values of 
and T b . During a pitch lift the imposed torque load is the 
output. During a pitch drop the imposed torque load is the 
input with the normal "input" torques opposing the motion 
and acting as "outputs". 

The loading system makes it impossible to apply a 
torque about the yaw axis without also applying a torque 
about the pitch axis. For simplicity torque data were taken 
only in pitch moves (pitch lifts and drops) of 20 to 30° 
with the load arms close to horizontal. The change in 
torque due to small rotations from the horizontal was 
neglected. The joint was operated at four load levels: 0, 
17.96, 60.44 and 100.73 ft lbs output torque about the pitch 
axis. Figures 50a and 52 illustrate the loading 
arrangement. TABLE 14 summarizes the data files from which 
torque data are obtained and the figures on which the torque 
plots can be found. 

The frictional loss at zero load can be calculated from 
the torque data on Figures 58a, 58b and 72a. The presence 
of the yoke (Figure 52) applies a small but non-zero torque 
at the output during pitch lifts and drops. Its effect can 
be cancelled by averaging the input torques for the lift and 
drop moves. The input torques during pitch lifts (Figures 
58a and 72a) average +1.07 ft lbs. The input torques during 
pitch drops average +0.24 ft lbs. The average of these, 
+0.66 ft lbs, is probably a reasonably good representation 
of tare loss in the joint. This represents about 0.5 
percent of the full load rating. The torque ripple in the A 
side input, which was present for all of the runs made, did 
not result in any statistical difference in absolute 
magnitudes between the A and B side torques. The 
algebraically positive input torque (A side with load arms 
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forward, and B side with the load arms rearward) was 
slightly greater in magnitude than the algebraically 
negative torque for all of the pitch moves. 

Efficiency increases with increasing load. At 60 ft 
lbs torque (slightly less than 50 percent of full load 
rating) efficiency values between 88 and 98 percent were 
obtained. Figure 79 is a plot of all of the torque data 
tabulated on TABLE 14. Efficiencies of 98 percent or better 
can be expected when the joint is loaded at 70 percent or 
greater of full load rating. 

Figures 75 through 78 show the torque plots at load 
torques of 17.96, 60.44 and 100.73 ft lbs. Input torques 
become increasingly irregular at higher values of load 
torque because of inertia. Torques were averaged over the 
constant speed region of the move for the efficiency 
calculations. The relatively short duration of a typical 
move (less than one second) requires an initial acceleration 
up to speed, followed by a constant speed region, and a 
deceleration to a stop. The duration of the constant speed 
region is approximately 0.35 seconds. During acceleration 
and deceleration input torques can be high and irregular due 
to bouncing of the weights at the end of the load arms. As 
shown on Figures 75 through 78, input torques are irregular 
and asymmetric during the acceleration and deceleration 
portions of the move, reaching values as high as 35 ft lbs. 
This compares with steady state values of +14.4 ft lbs at 
the highest torque load (Figure 78) . 

It is apparent that for more precise torque and 
efficiency analysis a low inertia, damped load system would 
have to be employed. 
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TABLE 1 - GEAR DATA FOR THE 
WRIST-ROLL JOINT ROLLER-GEAR DRIVE 


GEAR 

a 

x i 

y i 

x 2 

c 

Number of teeth 

24 

51 

15 

60 

164 

Diametral pitch 

43 

43 

38 

38 

38 

Pitch dia . , in . 

.5581 

1.1860 

.3947 

1.5789 

4.3158 

Pressure ang.deg. 

20 

20 

20 

20 

20 

Base Circle 
dia. , in. 

.5245 

1.1145 

. 3709 

1.4837 

4.0555 

i 

Circular tooth 
thickness, in. 

.0392 

.0387 

.0319 

.0314 

.0440 

.0435 

.0315 

.0310 

.0454 

.0444 

Outside or Major 
dia. , in. 

.6126 

1.220 

.4552 

1.600 

4.3626 

.6120 

1.219 

.4547 

1.599 

4.3679 

Root or Minor 
dia. , in. 

.5121 

1.1199 

.3415 

1.4913 

4.284 

.5056 

1.1134 

.3341 

1.4839 

4.285 

True involute 
form dia. (max) 

.5318 

1.1462 

.371 

1.5255 

4.354 

Msrg.pin dia., in. 

.040 

.040 

.050 

.050 

.050 

Measurement over 
(between) pins 

.6194 

1.2293 

.4744 

1.6344 

4.2201 

.6182 

1.2279 

.4735 

1.6331 

4.2231 

Operating Center 
Distance (ref.l) 

.870 

.870 

.9775 


1.3749 

Contact Ratio 

1.66 

1.66 

* 1.30 

Backlash at 
Operating Center 
Distance, (ref.l) 

.0015 

. 0005 

.0007 



.0015 

.0015 

.0017 


.0025 

Operating Pitch 
Dia. , (ref.l) 

.5568 

1.1832 

.3910 

-1.564 
1.5864 — 

4.3361 

Mating Roller Dia. 

.5568 

1.1832 

.3910 

-1.564 
1.5864 - 

4.3344 

Dwg.No. (Steel) 

NAS-141 

NAS-147 

NAS-144 

NAS-152 

NAS-155 


NAS-147 


Mating Roller Dia 
Dwg.No. (Steel) 
Dwg.No. (Plastic) 


NAS-182 
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TABLE 2. - ROLLER AND GEAR MATERIALS 
FOR THE WRIST-ROLL DRIVES 



STEEL DRIVE 
(NAS-140A) 

PLASTIC DRIVE 
(NAS-140AP) 

SUN 



ROLLER a 

AMS 6490 M-50 

AISI 4340 

GEAR a 

1 ETD 150 

DELRIN 100 

FIRST PLANET 



ROLLER 

AMS 6490 M-50 

TORLON 4203 

GEAR x^ 

1 ETD 150 

X ETD 150 

ROLLER yi 

AMS 6490 M-50 

AISI 4340 

GEAR 

X ETD 150 

X ETD 150 

SECOND PLANET 



ROLLER X 2 

AMS 6490 M-50 

TORLON 4203 

GEAR x 2 

X ETD 150 

DELRIN 100 

RING 



ROLLER c 

AMS 6490 M-50 

AISI 4340 

GEAR c 

1 ETD 150 

1 ETD 150 


X LA SALLE ETD 150 
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TABLE 3. - GEAR AND ROLLER MATERIALS 
FOR THE STEEL-PLASTIC WRIST-ROLL DRIVE 



GEAR 

ROLLER 

SUN 

DELRIN 

' 

1 STEEL -®- 

1st ROW 




GEAR 

X STEEL -*■ 


TORLON 

PINION 

1 STEEL -h 


1 STEEL 

2nd ROW 




1st 

DELRIN 


TORLON -v- 

RING 

DELRIN 


TORLON -* -i 

RING 

2 STEEL 


2 steel 


1 LA SALLE ETD 150 STEEL 
2 AISI 4340 STEEL 
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TABLE 4. - ROLLER DIAMETERS AND DRAWING 
SOURCES FOR WRIST-ROLL DRIVES 


ROLLER 

STEEL 

DRIVE 

DRAWING 

NO. 

PLASTIC 

DRIVE 

DRAWING 

NO. 

a. Dim. 

.5569 


.5570 

NAS-142P, 


.5567 

NAS-143 

.5568 

NAS-183 

Material 

M-50 Steel 


4340 

NAS-1 4 6P , 


(AMS-6490) 

NAS-146 

Steel 

NAS-183 

x-l Dim. 

1.1833 


1.1840 



1.1831 

NAS-149 

1.1836 

NAS-1 4 9P 

Material 

M-50 Steel 


Tor Ion 



(AMS-6490) 

NAS-148 

4203 

NAS-1 4 8P 

Yl Dim. 

.3911 


.3912 



.3909 

NAS-149 

.3908 

NAS-149P 

Material 

M-50 Steel 


4340 



(AMS-6490) 

NAS-146 

Steel 

NAS-1 4 6P 

x 2 Dim. 

1.5643 


1.5662 



1.5641 

NAS-154 

1.5658 

NAS-154P 

Material 

M-50 Steel 


Torlon 



(AMS-6490) 

NAS-154 

4203 

NAS-154P 

Y 2 Dim. 

1.5871 


1.5886 



1.5869 

NAS-154 

1.5882 

NAS-154P 

Material 

M-50 Steel 


Torlon 



(AMS-6490) 

NAS-154 

4203 

NAS-1 5 4P 

c Dim. 

4.3356 


4.3365 



4.3346 

NAS-156 

4.3355 

NAS-15 6P 

Material 

M-50 Steel 


4340 



(AMS-6490) 

NAS-156 

Stee 

NAS- 15 6 P 
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TABLE 5 - GEAR DATA FOR THE 
HINGE-JOINT ROLLER-GEAR DRIVE 


GEAR 

a 

X 1 

y i 

x 2 

c 

Number of teeth 

28 

62 

20 

100 

264 

Diametral pitch 

32 

32 

28 

28 

28 

Pitch dia. ,in. 

. 875 

1.9375 

.7143 

3.5714 

9.4286 

Pressure ang.deg. 

20 

20 

20 

20 

20 

Base Circle 
dia. , in. 

.8222 

1.8207 

.6712 

3.3560 

8.8600 

Circular tooth 
thickness, in. 

.0519 

.0338 

.0663 

.0614 

.0617 

.0514 

.0333 

.0658 

.0609 

.0607 

Outside or Major 
dia. , in. 

.9461 

1.9529 

.8145 

3.6583 

9.4929 

.9455 

1.9519 

.8135 

3.6573 

9.5000 

Root or Minor 
dia. , in. 

.8111 

1.8239 

.6602 

3.5040 

9.370 

.8023 

1.8151 

.6502 

3.4940 

9.372 

True involute 
form dia. (max) 

.8369 

1.8629 

.6846 

3.5410 

9.476 

Msrg.pin dia., in. 

.060 

.060 

.06857 

.06857 

.06857 

Measurement over 
(between) pins 

.9768 

1.9961 

.8423 

3.6975 

9.2967 

.9757 

1.9947 

.8414 

3.6963 

9.2996 

Operating Center 
Distance, in. 

1.390 

2.: 

L650 

6 . i 

630 

Contact ratio 

1.69 

H 

55 

1 J 

8 

Backlash at 
Operating Center 
Distance, in. 

.001 

.002 

.0013 

.0023 


.001 

.002 

Operating Pitch 
Diameter, in. 

.8649 

1.9151 

.7217 

3.6083 

3.5511 

9.3749 

Mating Roller 
Dia. , in. 

.8649 

1.9151 

.7217 

3.6083 

3.5511 

9.3749 

Drawing No. 

NAS-302 

NAS-305 

NAS-307 

NAS-305 

NAS-306 

NAS-311 

MAS-313 
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TABLE 6. - ROLLER AND GEAR MATERIALS 
FOR THE HINGE-JOINT DRIVE 


SUN 

Roller a 
Gear a 

FIRST PLANET 
Roller 

Gear xj 
Roller yj_ 

Gear 

SECOND PLANET 

Roller X 2 
Y 2 

Gear X 2 

RING 

Roller c 
Gear c 


MATERIAL 
(Steel Alloys) 

-] 

DRAWING NO. 

AMS -6 490 
Rc 61-63 

NAS-303 

Nitralloy 135 M 


.005/. 008 in. CASE, 
Rc 60-63 

NAS-302 

AMS-6490 
Rc 61-63 

NAS-310 

Nitralloy 135M 

NAS-307 

.005/. 008 in. CASE, 
Rc 60-63 

NAS-305 

AMS-6490 
Rc 61-63 

NAS-309 

Nitralloy 135M 

NAS-306 

.005/. 008 in. CASE, 
Rc 60-63 

NAS-305 

AMS-6490 

NAS-312 

Rc 61-63 

• 

Nitralloy 135M 


.005/. 008 in. CASE, 
Rc 60-63 

NAS-311 

AMS-6265 (AISI 9310) 


.030/. 045 in. CASE 
Rl5N 89.5-91 

NAS-314 

SAE 4340 
Rc 33-38 

NAS-313 









TABLE 7 


. - ROLLER DIAMETERS AND DRAWING 
SOURCES FOR HINGE-JOINT DRIVE 


DIAMETER, in. 


DRAWING NO. 


SUN 


FIRST PLANET 


Yl 


SECOND PLANET 


y 2 


RING 


8655 

8653 


1.9157 

1.9155 


.7223 

.7221 


3.6089 

3.6087 


3.5520 

3.5518 


9.3685 

9.3689 


NAS-301 


NAS-304 


NAS-304 


NAS-312 


NAS-312 


NAS-314 
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TABLE 8 - ZEROL BEVEL GEAR STRESSES AND REACTION 
FORCES FOR PITCH/YAW JOINT ROLLER-GEAR DRIVE 
Standard Involute 20° P.A. 


Face Width, 
nun (in.) 


GEAR 

Input 

Pinion 

Intermediate 
Fixed Gear 

Intermediate 

Transversing 

Gear 

Pitch- 

Yaw 

Gear 

73.74 

16.26 

45 

45 

16 

16 

12 

12 

44.45 

(1.75) 

152.4 

(6.00) 

82.55 

(3.25) 

82.55 

(3.25) 

28 

96 

39 

39 



12.7 

(.50) 


Tooth Bending 

Stress, GPa .181 .181 

(psi) (26,300) (26,300) 


.192 .192 

(27,800) (27,800) 


Tooth Comp. 
Stress, GPa 
(ksi) 


Separating 
Force, N(lb.) 


Radial 

Force, N(lb.) 


Axial 

Force, N(lb.) 


1.414 

(205) 


472 

(106) 



131 

(29.5) 


1.352 

(196) 




Drawing 


NAS-209 NAS-205 


NAS-207 













































TABLE 9 - ZEROL BEVEL GEAR GEOMETRY DATA 
(a) Input Pinion and Gear 



!l * * t * C 

» k. ^ ^ < 

I 

:» o o o 


t i ci 

v^KO **«-ft»«# o »• QO «• 


,N Q OO O « » 


Z ft* MI(C 


• NO • »^o • o o O O O O O <# 

Q9k V QNOO • • 


• 

x 

* • 

m 

• 

ft I • • 

• • • • • 

• ae • • 

• N 

ft ft 

• • z 

ft 



Ml 






Ml 

•M 





• 

ft. 

• • 

• 

• 

• ft ft 

• • • • • 


ft ftft 

ft ft 

ft t» 




•< 




X 


_ •• 

O 


1 ^ z 

X 



z 

M 



X 

***** 

o 

Ml 


ft- at 



• 

W 


• 


ft • -J • 

• • • • • 

ft 1 

» z 

ft ft 

(9 IN 

1 



»“ 

Ml O 


Cft 

ai 


9 X K 

o 


Z «• 




M 

X X 


X 

• • 

• • • • • 

• W m y 

ft J 

ft ft- 

Ml • 

X 



M « IS • ■«iiz 9 V>>C 

X • N OH< W WMM 3 


O ON J 
CN Z ft. C 

M N O ft. O 


^ J**.' 

JW • «V9 J4f 


M I • 0 < 

at k ft y ft 

I O ooa 


»• ft ON • <9 *W<2< JCftCft «Z I O O OM • 

Owe ft- ft- z J < < W O W ft ft ft 3 M 

ft z «( j j o < • a j J ft Oft JO • ftj k o w w O • 

O J< J < W Z« JftNCOftft KO< ft < MM 

KN3CftCJwyy«ftftftftw C wft ft ft ft 30 • 
ftj wccftOJwj MCMMrzft yy ft w m< 

t-OCOftOZOftOXftMft OOMft ft K ft Z O ft • 

ftZMZOZftZftZOMftMftVMZMftZftS ft ft ft 

ft w X ft <e M O Z ft- 9 ft M O ft tf Kftft 

Z « ft Z ft zc ft M u ft Z ZZ m2 «m O 


0 0 3 1 w K O ft V N. Ml tel • I w • 

ft ft n y (k*f ft .9 > ft e 

Ml Ml • O I I 9 ft ft M MO O M 

uu ftftft ft a ft ft o j 

ZZ OUOft w Z J J O O W W ft 

ftftftftftouwoo i a ft < y m 

J J WM Wftft A>> ft ft M M O O 

ftftft < Wft MZZ O O ft 

a Oft ft ft ft j m m ftftaoca< 


ftftZMWZOOMft 

iSMZMftZoaOw 

OCHftftMCOOZ 


MZOOOOOftO 


3 a ft < ftfta ja om woo ft ftftft z 

Q fttf K««0(9ftMftZ J J ft ft X M 

Z y Z wozZyayM mo O j jkk wzi 

mi cyyftftwaceccftikMM ftftft ft jo: 

O Oft(fftW««OXOOOOftft M M ft ft ft y I 

O Wft 03 <Nftttf 3 aW 0 K<ft KXMM 30 ; 

ft (0MwgftM«l(»a<9MK IKK ft ft WIM O ft | 



Z Stz S t S 8 S 

OO *- O *r* O O NN 0«>O 

Of- OOONNO ^ M non 

OIN OOftftNO «-oo^>o 

• ft • ••••• ft ft ft ft • 

OO ^OftNNO OOOQ ft 


i t t i : : 8 i t t : : ret 

M> NMft 

ft ftMft ftftNfNft.MN N ft AO 

ooooooooeooo n» x ci 

«N Ci O A a. 

0000000000000*30. 

ft N 


see 
o o o 


• a a 

ooo 


SSSCSS. t* 
Q«ftKN>a«p 



V- 3 O a O OOm 


8 t I t I K t 8 S s : 

O • r MNO O 

3 WftftftNONftMf- 

O OOOOOOO OO o z 

• •••••••••• N 

0000003000 0 a. 




74 



TABLE 9 - ZEROL BEVEL GEAR GEOMETRY DATA 
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TABLE 10 - BEVEL ROLLER GEOMETRY, 
LOADS AND STRESSES FOR PITCH/YAW 
JOINT ROLLER-GEAR DRIVE 


ROLLER 


Input 

Intermediate 

Intermediate 

Pitch/ 


Fixed 

Transversing 

Yaw 


Cone Half 
Angle, deg. 

16.26° 

73.74° 

45° 

45° 

Pitch Rad. 
mm (in.) 

18.445 

(.726) 

63.246 

(2.490) 

46.83 

(1.8438) 

46.83 

(1.8438) 

Face Width, 
mm (in.) 

9.525 

(.375) 

9.525 

(.375) 

11.226 

(.442) 

11.226 

(.442) 

Cross Rad. , 
mm (in.) 

oo 

381 

(15) 

381 

(15) 

oo 

Normal 
Load,N (lb.) 

4,899 (1,101) 

6,621 (1,488) 

Contact 

Ellipse, 

2a mm (in. ) 
2b mm (in. ) 

6.528 (.257) 
0.940 (.037) 

6.782 (.267) 
1.448 (.057) 

Maximum 
Hertz Stress 
GPa (ksi) 

1.53 (222) 

1.28 (186) 

Normal 
Approach, 
mm (in. ) 

0.020 (.0008) 

0.023 (.0009) 

Drawing 

NAS-210 

NAS-206 

NAS-208 

NAS-204 











































TABLE 11 - PITCH/YAW JOINT DRIVE PITCH 
AND TORSIONAL STIFFNESS DATA 


LOAD W, 
lbs (N) 

AVERAGE 

DEFLECTION, 

p PA +—P-P-R 
2 

in (mm) 

®P, rad 

K Q p in lb / Nn \ 

rad rad 

2.5 (11.13) 

.0028 (.0711) 

.00060 

137,000 (15,485) 

5.06 (22.52) 

.0049 (.1245) 

.00105 

158,500 (17,915) 

10. (44.5) 

.0108 (.2743) 

.00231 

142,400 (16,096) 

15.72 (69.95) 

.0181 (.4597) 

.00387 

133,600 (15,100) 
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TABLE 12 - PITCH/ YAW JOINT DRIVE YAW 
AXIS TORSIONAL STIFFNESS DATA 


LOAD W, 
lbs (N) 

AVERAGE 
DEFLECTION, 
Dy, in (mm) 

©•d=3 . 606W 
Kop , rad 
K 0 p=137 ,450 
(Figure 52) 

0y» 

rad 

Key 

in lb / Nm > 
rad rad 

2 

.0011 

.000052 

.000193 

338,000 (38,204) 

4 

.0028 

.000105 

.000515 

253,700(28,676) 

6.56 

.0058 

.000172 

.01104 

194,000 (21,927) 

10. 

.0122 

.000262 

.002403 

135,900 (15,361) 

15 

.0235 

.000394 

.00472 

103,800 (11,732) 
































TABLE 13 


DATA FILES USED FOR PITCH/YAW JOINT DRIVE ANALYSIS 




prm 

-L dea. 

YAW. 

dea. 

TORQUE ARM 

LOAD 

FILE . 

MANEUVER 

INITIAL 

FINAL 

INITIAL 

FINAL 

POSITICN 

TORQUE, ft lbs 

DATA 48 

PITCH LIFT 

-20.3 

20.1 

10.07 

10.8 

REARWARD 

60.44 

DATA 49 

PITCH CROP 

20.1 

-21.86 

10.8 

11.2 

REARWARD 

60.44 

DATA 63 

PITCH DROP 

-0.44 

-20.76 

10.07 

11.22 

REARWARD 

100.73 

DATA 64 

PITCH LIFT 

-20.76 

-0.11 

11.22 

10.93 

REARWARD 

100.73 

DATA 67 

PITCH DRCP 

-0.46 

20.26 

10.78 

10.69 

FORWARD 

17.96 

DATA 68 

PITCH LIFT 

20.26 

0.26 

10.69 

11.24 

FORWARD 

17.96 

DATA 71 

PITCH DRCP 

0.57 

20.65 

10.65 

10.89 

FORWARD 

60.44 

DATA 72 

PITCH LIFT 

20.65 

0.07 

10.89 

11.09 

FORWARD 

60.44 

DATA 76 

PITCH LIFT 

20.58 

-0.75 

11.02 

11.11 

ARMS OFF 
YCKE ONLY 

0 

DATA 77 

PITCH DROP 

-0.75 

20.21 

11.11 

10.93 

ARMS OFF 
YCKE ONLY 

0 

DATA 78 

YAW SWING 

0.07 

0.07 

-20.14 

10.56 

ARMS OFF 
YOKE ONLY 

0 

DATA 79 

PITCH DROP 

0 

20 

11 

11 

ARMS OFF 

n 

PITCH LIFT 

20 

0 

11 

11 

YCKE ONLY 


DATA 80 

OCW YAW SWING 

0 

0 

11 

30 

ARMS OFF 

0 

Dual move 

CW YAW SWING 

0 

0 

30 

11 

YOKE ONLY 


DATA 81 

OCW YAW SWING 

0 

0 

10 

30 

ARMS OFF 


Quadrille 

PITCH DROP 

0 

20 

30 

30 



move 

CW YAW SWING 

20 

20 , 

30 

10 

YCKE ONLY 

0 


PITCH LIFT 

20 

0 

10 

10 



DATA 82 

PITCH DROP 

0 

20 

11 

11 

FORWARD 

17.96 

Dial move 

PITCH LIFT 

20 

0 

11 

11 


DATA 83 

PITCH DROP 

0 

20 

11 

11 

FORWARD 

60.44 

nual move 

PITCH LIFT 

20 

0 

11 

11 
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TABLE 14 - PITCH/YAW JOINT DRIVE TORQUE DATA 


FILE 

FIGURE 

MANEUVER 

INPUT 
TORQUES , 
ft lbs 

LOAD 
TORQUE, 
ft lbs 

EFFICIENCY, 

Data 







76 

58a 

Pitch Lift 

+ 1.1 


0 


79 

72a 

Pitch Lift 

+ 1.04 




68 

75a 

Pitch Lift 

+3.71 


17 .96 

70.6 

82 

73a 

Pitch Lift 

+3.54 



73.8 

48 

76a 

Pitch Lift 

+9. 


60 .44 

97.9 

72 

77a 

Pitch Lift 

+10. 



88.1 

64 

78a 

Pitch Lift 

+ 15. 

100.73 

97.9 

77 

58b 

Pitch Drop 

+0.16 


0 


79 

72a 

Pitch Drop 

+0.32 




67 

7 5b 

Pitch Drop 

+ 2.58 

. 

17.96 

98.5 

82 

73a 

Pitch Drop 

+2.9 



> 100 

49 

76b 

Pitch Drop 

+ 8.0 


60.44 

94.0 

71 

77b 

Pitch Drop 

+ 8.51 



96.5 

63 

78b 

Pitch Drop 

+ 14.4 


100.73 

98.1 
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FIGURE 1 - POWER AND PCWER CONTROL 
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FIGURE 4 - TORQUE SENSOR REFERENCE SIGNAL 











IPK.A- < * 0 **- 



86 












FIGURE 7 - MOTOR SHAFT RESOLVER REFERENCE SIGNAL 
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FIGURE 8 - MOTOR SHAFT RESOLVER POSITION SIGNAL 
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FIGURE 10 - PITCH, YW AND MOTOR SHAFT RESOLVER VELOCITY SIGNALS 
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FIGURE 11 - PITCH, YSW AND MOTOR RESOLVER SIGstAL PCWER AMPLIFIERS 




FIGURE 12 - Linearity of Hinges Joint Drive 
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incremental transmission ratio incremental transmission ratio 


29.5 



FIGURE 15 - Incremental Linearity of 'Hinge-Joint 

Drive 



FIGURE 16 - Hinge-Joint Drive worst-case nonlinearity 

34 


drive torque (N-m) drive torque (N-m) 


/ 




FIGURE 17 - Friction of Steel Wrist-Roll drive, 
unloaded, as a speed reducer (dry) . 



velocity of low-speed shaft (rad/sec) 

FIGURE 18 - Friction of Steel Wrist-Roll drive, 

unloaded, as a speed increaser (dry) . 
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drive torque (N-m) drive torque (N-m) 



FIGURE 19 - Friction of Steel Wrist-Roll drive, 

unloaded, as a speed reducer (lubricated) . 



FIGURE 20 - Friction of Steel Wrist-Roll drive, 

unloaded, as a speed increaser (lubricated). 
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torque of driven output (N-m) input torque (N-m) 



input velocity (rad/sec) 

FIGURE 21 - Friction of Plastic Wrist-Roll drive 
as a speed reducer. 



output velocity (nd/sec) 

FUGURE 22 - Friction of Plastic Wrist-Roll drive 
as a speed increaser. 
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FIGURE 23 - Friction of Hinge-Joint drive, 
unloaded, as a speed reducer. 



inpta speed (rad/sec) 

FIGURE 24 - Friction of Hinge-Joint drive, 
unloaded, as a speed increaser. 
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(degrees) 









oupui angle (degrees) ouput angle (degrees) 



FIGURE 27 - Backlash data for the Plastic Wrist-Roll drive. 



inpra angle (degress) 

FIGURE 28 - Backlash data for the Hinge-Joint drive. 
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LOAD 

DRIVE 350 i n 1 b 

DC TORQUE 



a) Schematic 


TEST 

DRIVE 5 0 i n 1 b 


TORQUE DC 

METER SERVOMOTOR 



I f LUb 

|INTEGRAL SPEED] 
CONTROLLER 



b) Photo showing test arrangement and data processing 
system 

FIGURE 29 - Test setup for efficiency measurements 
of the Wrist-Roll drives. 
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ORIGINAL PAGE 
CulOR PHOTOGRAPH 



c) Steel Wrist-Roll drive, partially assembled 



d) Plastic Wrist-Roll drive, partially assembled 


FIGURE 29 - Test setup for efficiency measurements 
of the Wrist-Roll drives. 
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power (Walls) output torque (N-m) 


25 


20 - 


If - 


10 - 


51- 


qI 1 1 : 1 ; 1 1 1 

-200 -150 -100 -50 0 50 100 150 200 

input velocity (rad/sec) 

FIGURE 30 - Controlled input velocities and output torques 
(typ) for the Steel Wrist-Roll drive (lubriaatad) . 



FIGURE 31 - Controlled output (low-speed) power (typ) for 
the Steel Wrist-Poll drive (lubricated) . 
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TEST 

DRIVE 


lO.OOOinlb 

REACTION 



INTEGRAL TORQUE 
FEEDBACK LOOP 


a) Schematic 



b) Photo showing Hinge-Joint drive and reaction 
torquemeter 


FIGURE 32 - Test setup for static measurements of the 
Hinge-Joint drive. 
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ORIGINAL PAGE 
COLOR PHOTOGRAPH 



c) Hinge-Joint drive, partially assembled 


FIGURE 32 - Test setup for static measurements of the 
Hinge Joint drive. 
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power (Wails) input torque (N-m) 


1.* 



input velocity (rad/sec) 

FIGURE 33 - Steel Wrist-Roll drive input torques (dry) 
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input torque (N-m) efficiency 


1 



input velocity (rad/see) 

FIGURE 35 - Steel Wrist-Roll drive efficiency (dry) . 



input velocity (rad/sec) 

FIGURE 36 - Steel Wrist-Roll drive input torques 
(lubricated) . 
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efficiency P owcr (Waits) 



input veiodry (rad/sec) 

FIGURE 37 - Steel Wrist-Roll drive input power (lubricated) . 



input velocity (nd/sec) 

FIGURE 38 - Steel Wrist-Roll drive efficiency (lubricated) . 
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power (Waits) 


0 



input velocity (rad/sec) 


FIGURE 39 - Plastic Wrist-Roll drive input torques. 



-200 -150 -100 -50 0 50 100 150 200 

input velocity (tad/sec) 

FIGURE 40 - Plastic Wrist-Roll drive input power. 
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input torque (N-m) efficiency (highest four loads) 



input velocity (rad/sec) 

FIGURE 41 - Plastic Wrist-Roll drive efficiency. 



dove angle into first transagsinn (tad) 

FIGURE 42 - Hinge- Joint drive quasi-static input 
torques. 
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-4-3-2-10 1 2 3 4 

drive an gle fnm gist transmission (iad) 

FIGURE 43 - Hinge-Joint drive quasi-static output torques. 



-25 -20 -15 -10 -5 0 5 10 15 20 25 

input torque (N-m) 

FIGURE 44 - Hinge-Joint drive torque hysteresis. 
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output iorque (N-m) input torque (N-m) 


1.1 


1 

0.9 
0.8 
0.7 
0.6 
0.5 
0.4 
03 
02 
0.1 

-200 -150 -100 -50 0 50 100 150 200 

inpur velodry (tad/sec) 

FIGURE 45 - Steel Wrist-Roll drive input tongues (lubricated) . 
(Reverse *feasurement: high-speed torque source, lew-speed 

velocity source) . 




input velocity (rad/sec) 

FIGURE 46 - Steel Wrist-Roll drive output tongues (lubricated) 
(Reverse Measurement: high-speed tongue source, lew-speed 

velocity source) . 
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power (Watts) power (Watts) 



-200 -150 -100 -50 0 50 100 150 200 


input velocity (nd/sec) 

FIGURE 47 - Wrist-Roll drive low-speed power (lubricated) . 
(Reverse Measurement: high-speed torgue source, low-speed 
velocity source) . 



input velocity (rad/sec) 

FIGURE 48 - Wrist-Roll drive high-speed power (lubricated) . 
(Reverse Measurement : high-speed torrrue source, lew-speed 

velocity source) . 
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efficiency 


1 
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ORIGINAL PAGE 
COLOR PHOTOGRAPH 



a) Pi tch ax i s 





COLOR F-nj; OuRAOH 



c) Pitch-Yaw Joint drive, partially assembled 


FIGURE 50 - Test setup for Pitch-Yaw Joint drive 
stiffness measurements. 
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sample number 



sample number 

Figure 53 - Pitch/Yaw Joint motor carrrands for 
pitch lift (a) and pitch drop (b) . No load. 
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RPM RPM 







motor angles (degrees) motor angles (degrees) 







8 190 


185 


£ 185 



Figure 56 - Pitch/Yaw Joint desired and actual pitch and 
yaw positions for pitch lift (a) and pitch drop (b) . No load. 







sample number 

(b) data77: Filtered Pitch and Yaw Velocities 



sample number 

Figure 57 - Pitch/Yaw Joint pitch and yaw velocities for pitch 
lift (a) and pitch drop (b). No load. 
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torque (ft-lbf) torque (ft-lbf) 



sample number 


(b) data77: Filtered Torques A and B 



sample number 

Figure 58 - PitchAaw Joint input torques for pitch lift (a) 
and pitch drop (b) . NO load. 
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Motor Command (Volts) 




(a) data78: Filtered Motor Commands A and B 



Figure 59 - Pitch/Yaw Joint motor carmands (a) and motor 
speeds (b) for a yaw swing. No load. 
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RPM torque (ft— Ibf) 





Figure 61 - Pitch/Yaw Joint input torques (a) and 
pitch and yaw velocities for a yaw swing. No load. 
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motor angles (degrees) • RPM 



(b) data79: Resolver A and Resolver B 



sample number 

Figure 62 - Pitch/Yaw Joint motor speeds and input resolver 
positions for a 20° pitch drop, followed ty a 20° pitch lift. 
Zero load. 







Angle (degrees) 


(a) doto79: Desired and Actual Pitch and Yaw 




sample number 


(b) dato79: Filtered Pitch and Yaw Velocities 



a. 0 Pf f 
tr ^ 


sample number 

Figure 63 - Pitch/Yaw Joint pitch and yaw positions and velocities 
for a 20° pitch drop followed by a 20° pitch lift. Zero load. 
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motor angles (degrees) RPM 


(a) dota82; Filtered Tach A and Tach B 



sample number 


(b) data82: Resolver A and Resolver B 



torque. 
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RPM Angle (degrees) 



somple number 

Figure 65 - PitchAaw Joint pitch and yaw positions and velocities 
for a 20° pitch drop followed by a 20° pitch lift. Load, 17.96 
ft lbs torque. 
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motor angles (degrees) RPM 







sample number 

Figure 67 - PitchAaw Joint pitch and yaw positions and velocities 
for a 20° pitch drop followed by a 20° pitch lift. Load, 60.44 
ft lbs torque. 
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motor angles (degrees) 





















motor angles (degrees) RPM 



sampte number 

Figure 70 - Pitch/Yaw Joint motor speeds and input resolver positions 
for a 20° yaw swing followed by a 20° pitch drop followed by a 20° 
yaw swing back and a 20 ° pitch lift. Zero load. 
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RPM Angle (degrees) 


(a) dato81: Desired and Actual Pitch and Yaw 



(b) data81: Filtered Pitch and Yaw Velocities 




a 20° yaw swing followed by a 20° pitch drop followed by a 20° yaw 
swing back and a 20° pitch lift. Zero load. 
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torque (ft— Ibf) torque (ft— Ibf) 


(a) data79: Filtered Torques A and B 



5 0 50 100 150 200 250 300 350 400 

sample number 



sample number 

Figure 72 - Pitch/Yaw Joint input torques for (a) 20° pitch drop- 
pitch lift and (b) 20° yaw swing and return. Zero load. 
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torque (ft— Ibf) torque ( ft — Ibf) 



sample number 

Figure 73 - Pitch/Yaw Joint input torques for 20° pitch drop 
followed by 20° pitch lift, (a) Load, 17.96 ft lbs torque; 

(b) Load, 60.44 ft lbs torque. 
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torque (ft— Ibf) 



sample number 


Figure 74 - PitchAaw Joint input torques for a 20° yaw swing 
followed by a 20° pitch drop, followed by a 20° yaw swing back 
and a 20° pitch lift. Zero load. 
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torque (ft — Ibf ) torque (ft— Ibf) 



sample number 

Figure 75 - Pitch/Yaw Joint input torque data for (a) pitch lift and 
(b) pitch drop. Load, 17.96 ft lbs torque. 
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torque (ft-lbf) torque (ft-lbf) 



(b) pitch drcp. Load, 17.96 ft lbs torque. 
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torque (ft— Ibf) torque (ft— Ibf) 



(b) pitch drop. Load, 60.44 ft lbs torque. 
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(a) data64: Filtered Torques A and B ' 



sample number 

(b) data63: Filtered Torques A and B 



m 



001 


CD 
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20 40 60 00 TOO I2C 

LOAD TORQUE, ft lbs 

Figure 79 - Pitch/Yaw Joint efficiency as a function of load torque i 
pitch moves . 
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APPENDIX A 


WRIST-ROLL JOINT ROLLER-GEAR DRIVE GEAR DATA 


Specifications for the Wrist Roll drive were: 


Nominal ratio 
Output torque 
Output speed 
Maximum diameter 


• 25:1 

' 26 Nm (230 in. lb.) 
120 rpm 

152.4 mm (6 inches) 


Cluster Geometry 


The cluster geometry chosen from the Phase I study (ref. 1), when carried 
forward into detail design, was found to present some assembly difficulties so 
a slightly modified four planet system was chosen from Table I of ref. I: 


o C = 6.000° 

Using equations 1 through 12 of ref. 1: 
(7/15) N y j ® integral number 
(13/60) N X 2 = integral number 
Selecting 


39.000 c 


yi 


= 15 teeth 


N X2 * 60 teeth 


a + x. 


.870 


N g * 24 teeth 


x| 


= 51 teeth 


x./a 


51/24 


2.125 


a = .870/3.125 = .2784 


in. 


.5916 in. 
.5568 


Operating P.D. a * (.2784) (2) 

Selecting a cutter with P ® 43 
Cutting P.D. a = 24/43 = .5581395 
Maximum permissible 0D of xj gear for clearance 


(. 5916 ) ( 2 ) = 1.1832 


X, = 51/43 = 1.1860465 


0D 


xl 


(.870) (sin 45) (2) = 1.2304 


Standard addendum = 1/43 = .02325 

Standard 0D X1 * 1 . 186 + 2 (.02325) = 1.2325 

Use a short addendum for xj = .70/43 * .0163 
Long addendum for a = 1.30/43 * .0302 

00 x] = 1.18605 + 2(. 0163) - 1.21865 in. 


A- ] 



(y|+x 2 )/(a+x,) = (sin 45°/sin 39°) = 1.1236038 

y, + x 2 = .9775353 x 2 /y, = 60/15 = 4 

yj = .1955071 in. x 2 = .7820284 in. 

Operating P.D. y, = (.1955070(2) = .3910142 
Operating P.D. x 2 = (.7820284) (2) = 1.5640568 
Selecting a cutter with P *38 

Cutting P.D. y, * 15/38 = .3947368 x 2 = 60/38 = 1.5789474 

(yl+x 2 ) sin(90+tfC ) 

2 « — T = 1.3748705 in. 

s in 0 


Selecting N c = 164 teeth (divisible by 4) 


Cutting P.O. c = 164/38 = 4.3157895 

c/x 2 = 164/60 = 2.733333 c - x 2 

x 2 * .7931947 in. c 

Operating P.D. x 2 with c gear = (.7931947) (2) = 
c with x 2 gear = (2 . 1680652) (2) = 
Ratio = (51/24) (164/15) = 23.233 


= 1.3748705 

* 2.1680652 in. 

1.586389 

4.3361304 


Gear Stresses 

Input torque = 230/23.233 = 9-9 in. lbs. at 2,788 rpm 


ax) contacts (4 contacts) 
F t = (9.90/4) (I/. 2784) = 8.89 lb. (2 N) 


Bending Stress 



f = .25 in. (face width) 

Y = .572 


s 8 


4,368 psi (12.54 N/m^) 


Steel : 


(8.89) (43) 
( .25) (.35) 



Plastics 


fasH.?;!) = 2 ' 6n psi < 7 - 67 N/ "*> 


(4,000 to 6,000 psi is OK for 10? cycles for Oelrin or Zyiel nylon) 

Pitch line velocity = LH-I1 • 5568) (2788) - 4 q£ fp m ( 2.06 m/s) 

12 . 

m G = 51/24 = 2.125 


m G + 1 

mg 


= 1.47 


Compressive Stress 


s * 5715 I (L L W m G » v = 55,400 psi (159 N/m 2 ) (4) 

y Of m G • 


OK for R c 30-38 steel 

yjxg contacts (4 gears, 2 contacts per gear) 

Torque = (9.90) (5 1/24) /4 = 5.26 in. lb. per gear 

F T = (5.26)/ (. 1955) (2) =13.4516 (59.85 N) 

f = .375 for yj f = .343 for x 2 f = .375 for c 

Steel: S fi = = 4,868 psi (13.98 N/m 2 ) 


OK for R £ 30-38 steel 


Plastics: 


j = 03.45) (38) = 2 84o j ( 8.15 N/m 2 ) 

(.375) (.48) 

OK for Delrin or Zyte I 

(2788)(.2784/.59l6)( tt )(.39l) ... _ . . .. . . 

Pitch line velocity = — = 134.3 fpm (.68 m/s) 


12 


m G = 60/15 = 4 

m G + * 


m. 


= 1.25 


Compressive Stress 


S c = 5715 J \ = 64 *° 00 P5i ('83-7 N/m 2 ) 
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Torque 


X£C contacts (4 contacts) 
230 in. lbs. 


F t = (230)/(2 . 1 68 ) (4) = 26.52 1b (118 N) 


Steel : 



Plastics: 


l 2 6 r 52) (38) » . 7,651 ps | ( 21.97 N/m 2 ) 

(.3^3) (.384) 

OK for R c 30-38 steel 


S B = l 2 <Li 2 ) m m 4,120 psi (11.83 N/m 2 ) 

(.343) (.713) 

Pitch line velocity * (120) (4. 336) ( tT ) = 136.2 fpm (.69 m/s) 

12 

m G = 164/60 * 2.733 


mg + 1 

m G 


S 


c 


.634 



(26.52) (.634) 
(.343) ( 1 . 586 ) 


- 31,800 psi (91.2 N/m 2 ) 
OK for R c 30-38 steel 


Gear Geometry and Measurement Data 

a - xj mesh (P - 43 ; = 20° 

CD , center distance = .870 in.. 

Operating P.D. a = .5568 xj = 1.1832 

Cutting P.D. a = 24/43 - .5581 Xj = 51/43 = I.l 86 u 

Operating pressure angle <p : 

Cutting P.D. x cos (p = Operating P.D. x cos <j> f 
.5581 cos 20° = .5568 cos 4> f 

<p t = 19.61778° 



BC, Base circle dia. 


( 6 ) 


= Cutting P.D. x cos ^ 

Base circle dia. a = .5245 Xj = 1.1145 

Operating pinion addendum = 1.20/43 = .0279 

Operating gear addendum = .80/43 = • .0186 

0.0. Pinion a = .5568 + 2 (. 0279) = .6126 in. 

0.0. Gear x, = 1.1832 +2(.0l86) = 1.2204 in. 

Cutting Standard addendum = 1/43 = .0233 

Cutting circular pitch = rt / 43 = .0730 

Nominal Tooth thickness = .073/2 = .0365 in. (.0363 with min. backlash) 

Pinion a addendum with respect to the cutting P.D.: 

addendum = (.5) (.6126 ■ .5581) = .02725 (addendum increases) 

Pinion a tooth thickness at cutting P.D.: 

T, * .0363 + (.02725 - .0233) (2 tan 20°) = .0392 in. 

Gear xj addendum with respect to the cutting P.O.: 

addendum = (.5) (1.2204 - 1. 1860) = .0172 (addendum decreases) 

Gear Xj tooth thickness at cutting P.D.: 

T, = .0363 - (.0233 - .0172) (2 tan 20°) = .0319 in. 


Pinion a 

tooth thickness 

, T£ , at operating P.D.: 




t 2 = 2 r 2 £ 

T, 

577 + inv <p - 

inv <p j| 

0 ) 

(7) 

2 r | - 

cutting P.D. 

= .5581 

2 r 2 = 

operating P.D. 

= .5568 


inv j 

ft B tan - < 

P 



i hv 

= .01490438 


inv <p ^ 

= .01403884 



~ *0396 in. 
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0 ) 


Ref. 6 p 25, Sect. 2 



1.1860 


Gear X| tooth thickness, T2 , at operating P.D.: 

T, = .0319 2r l = 

2r 2 = 1.1832 T 2 = .0328 in. (eq. 7) 

Operating circular pitch = ( -Tf ) ( . 5568) / (2) (12) = .072885 

Minimum backlash = .072885 - (.0396 + .0328) = .0005 in. 

Recommended tooth thicknesses: 

Pinion a = .0392/. 0387 at cutting P.D. 

Gear Xj = .0319/. 0314 at cutting P.D. 

Expected backlash .0005/. 0015 
Pinion a 

Maximum Root Dia. = .6126 - 4.32/43 - .5121 

Minimum Root Dia. = .6126 - 4.60/43 - .5056 


Gear x^ 

Maximum Root Dia. = 1.2204-4.32/43 = 1.1199 
Minimum Root Dia. = 1.2204 - 4.60/43 = 1.1134 


Pinion a 

Form 

Dia 

= J( 8C) P 2 + 

J^2 CDs in <p j 

- £<od) g 2 - (BC) G 2 ^ *] 2 

(8) 


(BC) p 

= 

.5245 

CD « 

= .870 



(0D) p 

= 

.6126 

(0D) ( 

. = 1.220 
I 



(bc) g 

= 

1.145 


= 19.61778° 


Pinion a 

Form 

Dia 

= .5318 




Gear x^ 

Form D 

ia 

- /<*)«* ♦[ 

2C0sin - 

[(0D)p 2 - (8C) p ^ 2 

(9) 


Gear 

Xj Form Dia 

= 1.1462 
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Contact Ratio = P P * P G ~ CDs, ' n 4* 1 

BP 


( 10 ) 


where : 


BP , Base Pitch ’= i- U (• 52 _ 4 .il = .0687 

24 


Pp = /(0D) p 2 - (BC) p 2 /2 
P G = \ (0D) g 2 - (BC) g 2 / 


(M) 

02 ) 


Contact Ratio = 1.66 

Minimum clearance for Xj gear = 2 (.870) (s inks) - 1.220 = .0104 in. 

M , Measurement over pins: 

Pinion a 2r,cos, 


M 


cos 


±1 + 


fl 


2x 


inv <fi ~ - ^1 + inv <j> 


2 2 r , ' r j cos £ 

Pressure angle at center of roll ; - 20° 


(13) 


04) 


<P: 


i nv 4 > - .01490438 


2x = pin diameter 


N = 24 


For Tj = .0392 ; 2r, = .5581 

inv (f> 2 = .030504 

<f> 2 = 25.13842° 

M, = .61935 

For T, = .0387 ; inv <p 2 = .02961 ; <f> 2 * 24.90283 c 


M, = .61824 

Pin measurement .61947.6182 with .040 diameter pins 


2x = .040 
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Gear 


*1 

r 3 

r 3 


2r^cos-2^ + 2x 

radius to center of roll 

T| cos 
cos <P 2 


For T, = .0319 ; 2 r , = 1 . i860 ; N = 51 

i nv <fr 2 ~ .01609 

<f> 2 ■ 20.4990° 
m 2 = J.2293 
For T, = .0314 

i nv £ = .01567 

<p 2 = 20.32459° 
m 2 = 1.2279 

Pin measurement 1.2293/1.2279 with .040 diameter pins 


2x 


05 ) 


06 ) 


.040 


mes 6 (P = 38 ; = 20°) 

CD = .9775 

Operating P.D. yj » .3910 ; x 2 = * .5640 

Cutting P.D. y f = 15/38 = .3947 ; * 2 = 60/38 = » -5789 

Operating pressure angle <fi j (eq. 5): 

<f> , = 18.45278° 

Base circle dia. y| = .3709 (eq. 6) ; x 2 = 1.4837 (eq. 6) 

Operating Pinion addendum = 1.22/38 = .0321 

Operating Gear addendum = .78/38 = .0205 

0.0. Pinion y, = .3910 + 2 ( .032 l ) = .4552 

0.0. Gear X 2 = 1 .5640 + 2 (.0205) = 1.6050 
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Cutting standard addendum = 1/38 = .0263 

Cutting circular pi tch = if /38 = .0827 

Nominal tooth thickness * .0827/2 = .0413 (with min. backlash allowance of 

.0002, use .0411) 

Pinion yj addendum with respect to the cutting P.D.: 

addendum = . 5 ( *4552 - .3947) * .03025 (addendum increases) 

Pinion yj tooth thickness at cutting P.D.: 

T, * .0411 + (.03025 - .0263) (2tan20°) * .0440 in. 

Gear x 2 addendum with respect to the cutting P.D.: 

addendum = .5(1.605 ~ 1.5789) * .01305 (addendum decreases) 

Gear x 2 tooth thickness at cutting P.D.: 

T, = .0411 - (.0263 - .01305) (2tan20°) » .0315 in. 

Pinion y| tooth thickness, T 2 , at operating P.D.: 


2r l 

= 

.3947 

^ = 

20° 

inv 

4> 

= .014904 

<p , = 

18.45278' 

i nv 


* .011617 

2 r 2 = 

.3910 



T, * .0440 





T 2 = .0449 in. 

(eq. 7) 


*2 

tooth thickness, T 2 , 

at operating P.D. : 


2 n 

= 

1.5789 

2 r 2 - 

1.564 


T, = .0315 

T 2 = .0363 in (eq. 7) 

Operating ci rcular ,pi tch = (if ) (-391 0) / 1 5 = .0819 

Minimum backlash = .0819 “ (.0449 + .0363) = .0007 in. 

Recommended tooth thicknesses: 

Pinion yj = .0440/. 0435 at cutting P.D. 

Gear x 2 = .0315/. 0310 at cutting P.0. 

Expected backlash .0007 to .0017 
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Pinion y 


Max i mum Roo t D i a . = 

.4552 - 

4.32/38 = 

.3415 

Minimum Root Dia. = 

.4552 - 

4.60/38 = 

.334) 

Gear X 2 




Max i mum Roo t D i a . = 

1.605 - 

4.32/38 » 

1.49)3 

Minimum Root Dia. = 

1.605 - 

4.60/38 = 

1.4839 

Pinion yj Form Dia (eq. 8): 




(BC) p = .3709 


CD = 

.9775 

(00) G = 1.605 


(0D) p 

- .4552 

(BC) g = 1.4837 


<f> , = 

■ 18.45278° 

Pinion yj Form Dia * .371 in. 



Gear Xj Form Dia (eq. 9): Gear Xj 

Form Dia = 

1.5255 in 

Contact Ratio (eq. 10): 




P p = .1319 (eq. 11) 

» 

P G - 

.3061 (eq. 

Contact 

Ra t i 0 

= 1.66 


M , Measurement over pins: 




Pinion yj 




For Tj = .0440 ; 

2r, = 

.3947 ; 

0 

0 

<NI 

II 

inv (j> = .0149 ; 

N =15 

; 2x = 

O 
W 1 

0 

inv <p 2 = .051 74 (eq 

• 14) 

; 0 2 = 

29.6493° 

r^ * .2134 (eq. 16) 

; m 3 

= .4744 

(eq. 15) 

For T | = .0435 ; 

inv <p 

2 = .0505 

(eq. 14) 


2 = 29.4232° ; r 3 = .2129 (eq. 16) 

M 3 = .4735 (eq. 15) 

Pin measurement .47447.4735 with .050 diameter pins 
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Gear x 2 


For T, = .0315 ; 2 r | = 1.5789 ; <f> = 20° 

inv (f> - .0149 ; N = 60 ; 2x = .050 

inv <f> 2 = .0162 (eq. 14) ; <f> 2 - 20.5418° 

M 4 = 1.6344 (eq. 13) 

For Tj = .0310 ; inv^ 2 = -0159 (eq. 14) 

<f> 2 = 20.4117° ; M 4 = 1.6331 (eq. 13) 

Pin measurement 1.6344/1.6331 with .050 diameter pins 

X 2 C mesh (P * 38 ; (fj - 20) 

CD ■ 1.3749 

Operating P.D. x 2 = 1.5864 ; c = 4.3361 

Cutting P.D. x £ = 60/38 = 1.5789 ; C = 164/38 = 4.3158 

Operating pressure angle ^ j (eq. 5) 

< p , = 20.73142° 

Base circle dia. x 2 = 1.4837 (previously derived) ; c = 4.0555 (eq. 6) 

Pinion x 2 tooth thickness, T 2 , at operating P.D. with gear c : 

2 r j = 1.5789 ; </>= 20° ; inv <f> = .014904 

(f> j = 20.73142° ; inv# ( = .01666 ; 2r 2 = 1.5864 

T 2 = .0289 in. (eq. 7) 

In order to have a backlash of .0005/. 002 between pinion x 2 and ring gear c 
the space width of gear c at its P.D. must be .0294 min. to .0304 max. 
Operating circular pitch of gear c = ( it ) (4 . 336 1 ) / 1 64 = .0831 
Gear c tooth thickness, Tj , at operating P.D. = .0831 - .02 94 = .0537 max 

= .083? - .0304 = .0527 min 
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( 17 ) 


Gear c tooth thickness, T 2 , at cutting P.D. of 4.3158 : 



t 2 ‘ 2 r z[ T : 

1 /2 r ] - inv^ | + inv ^ 

>J 


2r l 

« 4.3361 ; 

2r 2 = 4.3158 ; 

<P\ - 

20.73142 

inv 1 

tfi 1 - .01666 

i <f> « 20 ° ; 

inv 

» .01490 

when T| 

= .0537 

T 2 = '.0459 



when Tj 

= .0527 

t 2 = .0449 




Gear c tooth thickness at cutting P.D. = .0459/. 0449 

Expected backlash with x 2 gear = .0005/. 002 

Gear c circular pitch at cutting P.D. = ( 7T ) (4.3158)/164 = .08267 

Space widths at cutting P.D. » .0827 * .0459 * .0368 min. 

* .0827 ‘ .0449 - .0378 max. 

Gear c major dia. - Operating P.D. + (2) (gear x 2 Operating addendum) 

+ ( 2 ) (Clearance) 

Minimum clearance = .150/38 * .00395 

Maximum clearance = ,250/38 * .0066 

Operating P.D. = 4.3361 

Pinion x 2 operating addendum = (1.605 ‘ !.5864)/2 = .0093 

Gear c major dia. = 4.3679/4.3626 
Gear c tooth thickness, , at major dia.: 

= 2 r 3 j”r 2 (2 r 2 - inv ^> + inv (^) 3 J ( 18 ) 

2 r 2 = 4.3158 ; 2 r 3 - 4.3679 ; <f> - 20° 

inv <j> = .01490 ; cos<^ - (2r j) (cos (fi )/2r^ = .928484 

<j> 3 • 21.8003° ; inv ^> 3 = .0)949 ; T 2 * .0459 

T 3 = .06649 
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Gear c circular pitch at major dia = ( if ) (4.3679)/l64 = .08367 

Circular space at major dia = .08367 - .06649 = .017 min. 

This looks acceptable for this 38P cutter design. 

Calculation of gear c inside diameter for a minimum contact ratio of 1.3 

Contact Ratio = (Pp + CDsin<^>| - Pg)/BP (19) 

(0D) p = 1.605 ; (BC) p = .74184 ; P p = .3061 (eq. II) 

CDs in = .4867 ; BP = ( ff ) (4.0555)/l64 = .0777 

f G - y (I£»g 2 - (8C) 6 2 /2 (20) 

(|D)g to be solved for. 

Eq. 19: 

1.30 = (.3061 + .4867 - P G )/.0777 

P G = .6918 ; (BC) C = 4.0555 

Eq. 20: 

(ID) g = 4.285 ; Use (JD) g = 4.285/4.284 


Calculation for SAP (Start of Active Profile, i.e., True Involute Form) 

SAP pinion * 2 = | (BC) p 2 + [uiD)^ " ( BC ) / ) ? “ 2CDsin</-,J ^ * (2 1) 

(BC)p (pinion x 2 base dia.) = 1.4837 

( I D ) G (gear c min. internal dia.) = 4.284 

(BC) (gear c base dia.) = 4.0555 
G 

2 CDs in = (2) ( .4867) = .9734 

SAP pinion x 2 = 1.5385 


SAP gear c 

(od) b 


•{ 


(BC) ( 

.605 


4 


L 


2CDsin<^» | + ( (0D) p 2 - (BC) p 2 ) 2 


17 


( 22 ) 


SAP gear c = 4.354 
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Tip interference check: 


CD = 1.3749 

Gear c inside radius, (lR)g - 4.284/2 = 2.142 

Gear c base radius, (BR) g - 4.0555/2 * 2.0278 

Pinion X£ outside radius, (QR)p = 1.605/2 «= .8025 

Pinion X£ base radius, (BR) p = 1.4837/2 = .7149 


Pressure angle at pinion X 2 00 * <f> 4 
Pressure angle at gear c 10 = <p $ 
Operating pressure angle, <$> j = 20.7314° 


cos <f> 4 

<Pk 

inv 4> k 
sin <f> j 


(BR) P 

(0R) P 

22.42° 

.02128 

.3540 


.9244 


<f> | = .3618 rad. 


arc cos 

(IR)C 2 - (0R)p 2 - CD 2 

2 CD (OR) p 

4>e = 

21.45° 

arc cos 

[~(|R ) g 2 + CD 2 - (OR ) p 2 

2 CD ( 1 R) g 


<f> 7 = 7.876° 


For no tip interference 
X y Y 


cos ^ 5 • 

(br) g 

(ir) g 

?5 * 

18 . 80 ° 

i nv 5 * 

.01231 

cos 1 = 

.9353 


= arc cos .9307 
^6 ~ *3744 rad. 

= arc cos .9906 
<p 7 = .1375 rad. 


Where 

X = CD (s in ^ j - <p { cos^ j) + ( BR )p(r > 6 + ' inv< P^ 
Y = (BR) g [V 7 ♦ inv^ 2 J 


.9467 


(23) 


(24) 


(25) 

( 26 ) 
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X = .31^9 

Y = .3037 


Since X ) Y 

there wi 1 1 not 

be 

any tip 

interference 

M, Measurement between pins: 



For 

T, = .0459 

> 

2 r 1 * 

4.3158 


u 

to 

o 

o 


> 

c 

= .0149 


N = 164 ; 


2x = 

.050 

i nv 4f> n 

— + i nv d!) - 

T 

j_ - 

X. 

mv T 8 

N ” 

Tr 

1 r l 

cos <p 

i nv 

(j) Q * .0111 

> 

« 

oo 

18.1803° 


Mj. = (2r jcos ^}/cos - 2x 

M “ 4.2186 

p 

For Tj * .0449 

inv^g = .0113 ; ^8 * 18.3025° 

M 5 = 4.2216 

Measurement between pins 4.2186/4.2216 with .050 diameter pins. 


(27) 


( 28 ) 
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APPENDIX B 


HINGE-JOINT ROLLER-GEAR DRIVE GEAR DATA 

Specifications for the Hinge Joint drive were changed from those used 
for the original design in the Phase I study (ref. 1): 

Nominal ratio target 30:1 or higher 

Input torque 28.9 Nm (256 in. lb.) 

Output speed 120 rpm 

Maximum diameter target 12 in. (approx.) 


Cluster Geometry 

A cluster geometry with a somewhat greater toggle angle than that used 
in ref. 1 was chosen in an effort to meet the diameter target of 12 inches. 
The solution chosen from Table I of ref. 1 is 

oc = 18° * = 27° 

Using equations 1 through 12 and 15 of ref. 1: 

(2/5) Nyj = integral number N y j ** 20 teeth 

(3/20) N x2 = integral number N x2 ■ 100 teeth 


Selecting 

a + Xj = 1.390 
N , *62 teeth 

A I 

x, - 2.214286a 


N, * 28 teeth (divisible by 4) 

d 

x j/a = 62/28 - 2.214286 
a - 1.390/3.214286 ■ .432445 


xj = .957556 

Operating P.D. a = .8649 xj = 1.9151 

Selecting a cutter with P = 32 (20° pressure angle) 

Cutting P.D. a « 28/32 » .8649 x, - 62/32 ** 1.9375 

Max. permlssable Xj 00 • (1.390)(sin 45)(2) ■ 1.9658 
Standard addendum • 1/32 B .03125 
Use short addendum ■ .6/32 ■ .01875 

x, 0D » 1.9151 + 2 (.01875) - 1.9526 

Clearance = 1.9658 - 1.9526 = .0132 OK 
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From eq. (I): (All equation nos. taken from ref. 2) 

(y ] +x 2 )/(a+x ] ) = (sin 45°/sin 27°) = 1.55754 

y I + x 2 = 2.164976 x 2 /y, = 100/20 = 5 

y; = .360829 X 2 = 1 . 804 1 47 

Operating P.0. y, = (.3608293) (2) = .7 216586 
Operating P.D. x 2 = ( 1 .804 1465) (2) = 3.608293 
Selecting a cutter with P = 28 (20° pressure angle) 

Cutting P.D. y, = 20/28 = .7142857 x 2 = 100/28 = 3.5714286 

F rom eq . (2) : 

(y I + x_)sin(90 + oC ) 

z = *2.911886 

s i n 9 


Selecting N c = 264 (divisible by 4) 

Cutting P.D. c * 264/28 * 9.428571 

c/x 2 * 264/100 * 2.64 c - x 2 = 2.911886 

x 2 = 1.775540 c = 4.687426 

Operating P.0. x 2 with c gear = 3 . 55 1 080 
Operating P.D. c with x 2 gear = 9.374852 

Ratio = (62/28) (264/20) = 29.23 


Gear Stresses (Methods of ref. 3) 
Input torque = 256 in. lbs. 

Output torque = (256) (29.23) = 7483 in. lbs. 

ax] contacts (4 contacts) 

F T * (256/4) (1/. 4324) = 148 lbs. 

Selecting .312 in. face width, P = 32 , y * .344 
Bending Stress: eq. (3): 

S B = ( 1 48) (32 ) / ( . 3 1 2 ) (. 344) = 44,100 psi 
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m. 


G = 62/28 = 2.214 


m G ? 

nip 


= 1.45 


Compressive Stress, eq. (4): 
S c = 5715 


/ 


048) (1.45) 


(2) (.4324) (.3)2) 


= 162,000 psi 


Y ]*2 contacts (8 contacts) 
Torque = (256) (2.2 14) 0/4) = 141.7 in. lbs. 

F t =* (141. 7/2)(l/. 361) = 196.3 lbs. 

Selecting .56 in. face width, P = 28 , y = .33 

S B - ()96.3) (28)/ (. 56 ) (.33) =29,700 psi 

m G - 100/20 - 5 


K - (196.3) (1 .2}/ (2) (.361) (.56) = 583 
s c = 5715 > /583 = 138,000 psi 


x 2 c contacts (4 contacts) 

Torque = 7483 in. lbs. 

F t = (7483/4)0/4.687) = 399 lbs. 

Selecting .56 in. face width (gear x^) , P = 28 , y = ,38 
$ B = (399) (28)/ (. 56 ) (.38) = 52,500 psi in x 2 
Selecting .60 in. face width (gear c) , P = 28 , y = .38 
S B * (399) (28)/ (.60) (.38) = 49,000 psi in c 

m fi - 264/100 » 2.64 » .62 

K = (399) ( - 62) / (2 ) ( 1 .7755) (.56) = 124 

S c = 5715y/l24 - 63,800 psi 

With these levels of S 3 and $ c , a , xj , yj and x 2 gears should be 
case carburized 8620 steel or equivalent, case hardened to R c 58 - 61 , or 
nitralloy 135M nitrided to a case hardness of R c 60-63. Gear C need not 
have a hardened face. 
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Gear Geometry and Measurement Data 


a - xj mesh (P = 32 ; 0 = 20° ) 

CO, center distance = 1.390 in. 

Operating P.D. a = .8649 ; xj = 1°9151 

Cutting P.D. a = 28/32 = .875 ; x, = 62/32 = 1.9375 

Operating pressure angle 0 : 

From eq. (5) 

Cutting P.D. x cos 0 = Operating P.D. x cos 0j 
.875 cos 20° = .8649 cos 0 1 

0, = 18.0723° 

From eq. (6) 

BC, Base circle dia. = Cutting P.D. x cos 0 


B-4 



Base circle dia, a = .8222 


x 


= 1.8207 


Operating pinion addendum = 1.30/32 = .0406 
Operating gear addendum = .70/32 = .0219 

O.D. Pinion a = .8649 + 2 (.0406) = .9461 in. Use .946 1/. 9455 

0.0. Gear x, = 1.9151 + 2 ( . 02 1 9) = 1.9589 in. 

O.D. clearance = (1.390) (sin 45°) (2) - 1.9589 = .0069 (Too close) 

Stub O.D. to 1.9529 

Then O.D. clearance = 1.9658 - 1.9529 - .0129 OK 
Make O.D. 1.9259/1.9519 
Cutting Standard addendum • 1/32 = .0313 
Cutting circular pitch = -rr / 32 = .0982 

Nominal Tooth thickness = .0982/2 = .0491 in. (.0488 with .0003 backlash) 
Pinion a addendum with respect to the cutting P.D.: 

addendum = (.5) (.9461 - .875) = .0356 (addendum increases) 
Pinion a tooth thickness at cutting P.D.: 

T, = .0488 + (.0356 - .0313) (2 tan 20°) = .0519 in. 

Gear Xj addendum with respect to the cutting P.D.: 

addendum = (.5) (1.9589 " 1.9375) = .0107 (addendum decreases) 
Gear Xj tooth thickness at cutting P.D.: 

T, = .0488 - (.0313 - .0107) (2 tan 20°) = .0338 in. 

Pinion a tooth thickness, T£ , at operating P.D. (eq. (7)): 

r t, ~i(» 

T£ = |2 r 2 T 1 + inv 0 - inv 0jJ 

2rj = cutting P.D. 13 .875 ; 2^ = operating P.D. = .8649 

inv 0 as tan 0-0 

inv 0 = .01490438 inv 0, = .01089422 

T 2 = .0548 in. 
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Gear x| tooth thickness, T£ , at operating P.D. 

T, = .0338 2 r, = 1.9375 

2 = 1.9151 T 2 = .0411 in. (eq. 7 ) 

Operating circular pitch = ( tT ) (.8649)/(28) = .09704 

Minimum backlash = .09704 - (.05^8 + .0411) = .00)1 in. 
Recommended tooth thicknesses: 

Pinion a = .0519/. 0514 at cutting P.D. 

Gear X| = .0338/. 0333 at cutting P.D. 

Expected backlash .001/. 002 
Pinion a 

Maximum Root Dia. = .9461 - 4.32/32 = .8)11 
Minimum Root Dia. = .946) - 4.60/32 = .8023 

Gear xj 

Maximum Root Dia. = 1.9589 - 4.32/32 = 1.8239 
Minimum Root Dia. = 1.9589 - 4.60/32 = 1.8151 


From eq. (8) : 

Pinion a Form Dia = 


(BC) p - .8222 
(0D) p = .9461 
(8 C) g = 1.8207 
Pinion a Form Dia = .8369 
From eq. (9) : 

Gear Xj Form Oia 


= /( BC) p 2 + 2CDs i n 0, - £(00)g 2 - (BC) G 2 j j 


CD = 1.390 

(od) g = 1.9259 

0, = 18.0723° 


ia = j( BC) g 2 + 2CDsin0 - £(00)p 2 - (BC) p j * 


Gear Xj Form Oia = 1.8629 


From eq. { 10) : 


Contact Ratio = P P ♦ P G ' CDsin0i 

BP 
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where : 


BP, Base Pitch = - Tt ' ... )^ 8222 ) = . 0923 

From eq. (1 1): 

Pp = /( 0D) p 2 - (BC) p 2 '/2 
F rom eq. ( 12) : 

P G = /( 0°) G 2 - ( bc ) g 2 1 n 

Contact Ratio = 1.69 

M , Measurement over pins: 

Pinion a (eq. (13)) : 

M, = 2r icos0 + 2x 
cos0 2 

F rom eq. ( 14) : 

inv 0 2 = Tj/2rj + inv 0 + x/rjcos0 - rr / N 
0 2 = Pressure angle at center of roll ; 0 = 20° 

inv 0 = .01490438 ; 2x = pin diameter 

For T j = .0519 i 2r, = .875 ; N = 28 ; 2x = .060 

inv 0 2 = .03499 ; 0 2 = 26.2487° 

M, = .9768 

For Tj = .0514 ; inv 0 2 = .03442 ; 0 2 = 26.1133° 

M, = .9757 

Pin measurement .9768/. 9757 with .060 diameter pins 

Gear x, (eq. (13)): M 2 = 2r|C ° s ^ + 2x 

cos 02 

For T| = .0338 ; 2 r j * 1.9375 ; N = 62 ; 2x = .60 

inv 0 2 = .01463 ; 0 £ = 19.8823° 

M 2 = 1.9961 
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For T] = .0333 


inv 0 2 = .01438 ; 0 2 = 19.7685° 

M 2 = 1.9947 

Pin measurement 1.9961/1.9947 with .060 diameter pins 

yjx? mesh (P = 28 ; 0 ■ 20°) 

CD = 2.1650 

Operating P.D. yj = .7217 ; * 2 = 3.6083 

Cutting P.D. y, = 20/28 = .714 3 ; x 2 = 100/28 •« 3.5714 

Operating pressure angle 0| (eq. 5): 

0, = 21.5562° 

Base circle dia. = .6712 (eq. 6) ; x 2 = 3.3560 (eq. 6) 

Operating Pinion addendum = 1.30/28 = .0464 

Operating Gear addendum ■ .70/28 = .0250 

O.D. Pinion y, - .7217 +2(.0464) = .8145 use .8145/. 8135 

O.D. Gear x 2 = 3-6083 + 2(.0250) = 3.6583 use 3.6583/3-6573 

Cutting standard addendum - 1/28 = .0357 

Cutting circular pitch = rf /28 = .1122 

Nominal tooth thickness = .1122/2 = .0561 (with min. backlash allowance of 

.0003, use .0558) 

Pinion yj addendum with respect to the cutting P.D.: 

addendum = . 5 ( . 8 1 2*5 “ -7143) = .0501 (addendum increases) 
Addendum increase (hob pullout) = .0501 -.0357 “ .0144 
Pinion yj tooth thickness at cutting P.D.: 

T, * .0558 + (.0144) (2) (tan 20°) = .0663 in. 

Gear x 2 addendum with respect to the cutting P.D. : 

addendum = .5(3.6583 “ 3-5714) = .0435 (addendum decreases) 
Addendum increase (hob pullout) = .0435 - -0357 = .0078 
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Gear tooth thickness at cutting P.D. : 

Tj = .0558 + (.0078) (2) (tan 20°) = .0614 in. 
Pinion yj tooth thickness, T 2 , at operating P.D.: 


2 r , = .7143 
i nv 0 = .014904 
inv 0, = .018817 

T, = .0663 


0 = 20 ° 

0j = 21.5562° 
2r 2 = .7217 


T 2 = .0642 in. (eq. 7) 

Gear x 2 tooth thickness, T 2 , at operating P.O.: 

2 r j = 3.5714 2r 2 = 3.6083 

T, = .0614 

T 2 = .0479 in. (eq. 7) 

Operating circular pitch = ( tf )(.7217)/20 « .1134 

Minimum backlash = .1134 - (.0642 + .0479) * .0013 in. (OK - target was .001) 
Recommended tooth thicknesses: 

Pinion y j = .O 663 /.O 658 at cutting P.D. 

Gear x 2 = .0614/. 0609 at cutting P.D. 

Pinion yj tooth thickness, T3 , at O.D. (for adequacy of land width for shrink 

fit of x 2 gear) 


2r, = .7143 
2r 3 = .8145 (O.D.) 
T, = .0663 


0 3 (Pressure angle at O.D.) from eq. (5) 
cos 0^ = (.7143) (cos 20°)/. 8145 = .8241 
0 3 = 34.5035° 
inv 0 3 « .08517 


T 3 = .018 (eq. 7) 

This should be enough land to support the shrink fit. 
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Pinion yj 

Maximum Root Oia. = .8)45 ~ 4.32/28 = .6602 

Minimum Root Dia. = .8)45 - 4.60/28 = .6502 

Gear x 2 

Maximum Root Dia. = 3.6583 - 4.32/28 = 3.5040 

Minimum Root Oia. = 3.6583 - 4.60/28 = 3.4940 

Pinion yj Form Dia. (eq. 8): 

(BC) p = .6712 CD = 2. 1650 

(0D) 6 = 3.6583 (0D) p = .8145 

(BC) g = 3.3560 01 <= 21.5562° 

Pinion y^ Form Dia = .6846 in. 

Gear Xj Form Dia (eq. 9): 

Gear xj Form Dia = 3.5410 in. 

Contact Ratio (eq. 10): 

Pp = .2307 (eq. 11) P G = .7281 (eq. 12) 

Contact Ratio = 1.55 
M, Measurement over pins: 

Pinion y^ 

For T, = .0663 ; 2r, = .7143 ; 0 = 20° ; inv 0 = .0149 

N = 20 ; 2x = .0686 ; inv 0 2 = .0528 (eq. 14) ; 0 2 « 29.8359° 

M 3 = .8423 (eq. 13) 

For T, = .0658 ; inv 0 £ = .0521 (eq. 14) ; 0 2 = 29.7134° 

M 3 * .8414 (eq. 13) 

Pin measurement .8423/.84I4 with .0686 diameter pins 
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Gear x 2 


For T, = .0614 ; 2r, = 3.5714 ; 0 = 20° ; inv 0 = .0419 

N = 100 ; 2x = .0686 ; inv 0 2 = .0211 (eq. 14) ; 0 £ = 20.3649° 

M 4 = 3.6975 (eq. 13) 

For T, = .0609 ; inv 0 2 = .02097 (eq. 14) ; 0 £ = 22.3174° 

M 4 = 3.6963 (eq. 13) 

Pin measurement 3.6975/3.6963 with .0686 diameter pins 

x 2 c mesh (P = 28 ; 0 = 20) 

CD = 2.9119 

Operating P.D. x 2 = 3.551 I c = 9.3749 

Cutting P.D. x £ = 100/28 = 3.5714 ; c = 264/28 = 9.4286 

Operating pressure angle 0j (eq. 5) 

0] = 19.0798° 

Base circle dia. x 2 * 3.3560 (previously derived) ; c = 8.8600 (eq. 6) 

Pinion X 2 tooth thickness, T 2 , at operating P.D. with gear c; 

T, = .0614 ; 2r ( = 3.5714 ; 0 = 20° ; i nv 0 = .014904 

0, = 19.0798° ; inv 0, = .0)288 ; 2r 2 = 3.551 1 

T 2 = .0682 in. (eq. 7) 

In order to have a backlash of .001/. 002 between pinion x 2 and ring gear c, 
the space width of gear c at its P.D. must be .0692 min. to .0702 max. 

Operating circular pitch of gear c = ( rf ) (9. 3749/264) = .1116 

Gear c tooth thickness, Tj , at operating P.D. = .1116 - .0692 = .0424 max. 

= .1116 - .0702 = .0414 min. 
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Gear c tooth thickness, T 2 , at cutting P.D, of 9.4286 (eq. 17): 

T 2 = 2r 2 [' ,/2r, - inv 0, + inv 0~J 
2 r , = 9.3749 ; 2r 2 = 9.4286 ; 0j = 19.0798° 

inv 0, = .01288 ; 0 = 20° ; inv 0 = .01490 

when Tj = .0424 T 2 = .06 l 7 

when T, = .0414 T 2 = .0607 

Gear c tooth thickness at cutting P.D. = .0617/. 0607 
Expected backlash with x 2 gear = .001/. 002 
Gear c circular pitch at cutting P.D. = I rf ) (9.4286) /264 = .1122 
Space widths at cutting P.D. = .1122 - . 06 1 7 = .0505 min. 

= .1122 - .0607 = .0515 max. 

Gear c major dia. = Operating P.D. + (2) (Gear x 2 Operating addendum) + 

(2) (Clearance) 

Minimum clearance *» .150/28 = .0054 
Maximum clearance = .250/28 = .0089 
Operating P.D. = 9.3749 

Pinion x 2 operating addendum = (3.6583 - 3.551 0/2 = .0536 
Gear c major dia. = 9-5000/9.4929 
Gear c tooth thickness, Tj , at major dia. (eq. 18): 

Tj * 2r^ |^T 2 / 2 r 2 - inv 0 + inv 0^J 

2r 2 - 9.4286 ; 2r 3 = 9.500 ; 0 = 20° 


inv 0 = .01490 
0 3 = 21.1514° 


cos 0 3 = (2r 2 )(cos 0)/2r 3 = .9326 
inv 0, = .01774 ; T, * . 06 1 7 


Vj - • V « / / T $ I 2 

t 3 <= .0891 

Gear c circular pitch at major dia. = ( rf )(9.500)/264 = .1130 
Circular space at major dia. = .1130 - .0891 = .0239 

This looks acceptable for this 28P cutter design. 
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Calculation of gear c inside diameter for a minimum contact ratio of 1.48 


Contact Ratio = (Pp + CDsin 0] - P G )/BP (eq. 19) 

0| = 19.0798° ; CD = 2.9119 ; (0D) p = 3.6583 ; (BC) p = 1.678 

P p = .7281 (eq. II) ; CDsin0i = .9519 ; BP = ( rf ) (8.8600) /264 = .1054 

I 2 T” 1 

P G = / ( |0 ) G " < BC ) G 1 2 (eq * 20) 


(ID)j, to be solved for. 

Eq. 19: 

1.48 = (.7281 + .9519 - P G )/. 1 054 

p g - 1.5239 ; (ac) G = 8.860 

Eq. 20: 


(I0) G = 9.3696 


Use (I0) G = 9.370/9.372 


Calculation for SAP (Start of Active Profile, i.e., True Involute Form), eq. (21) 


SAP pinion x 2 = <^(BC)p 2 + £((lD) G 2 - 


2 1 “1 2 \ I 

(BC) G ) 2 - 2CDs i n0jj > 


(BC) p (Pinion x 2 base dia.) = 3.3560 
(ID) (Gear c min. internal dia.) —9. 370 

U 

(BC)q (Gear c base dia.) = 8.860 
2CDs i n0 j = 1.9037 
SAP pinion x 2 = 3.546 (eq. 21) 

(Can use previously calculated T.I.F. dia. of 3.541) 

SAP gear c =<^(BC) g 2 +^2CDsin0, + ( (0D) p 2 - (BC) p 2 )* J (eq. 22) 
(0D) p = 3.6583 


SAP gear c = 9.^76 (eq. 22) 

Tip interference check: CD = 2.9119 

Gear c inside radius, (IR) G * 9-370/2 = 4.685 
Gear c base radius, (B R) G = 8.860/2 = 4.430 
Pinion x 2 outside radius, (0R) p = 3 . 6583/2 = 1.8292 
Pinion x^ base radius, (BR) p =■ 3.356/2 = I .678 
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Pressure angle at pinion x 2 00 = 0^ 
Pressure angle at gear c 10 = 0^ 
Operating pressure angle, 0| = 19.0798° 
cos0 k = (BR) p /(0R) p = .9174 
0 4 = 23.4560° 
inv 0 /,. = .0245 
sin 0 j = .3269 


cos0 5 = (BR) g /(|R) g = .9456 
0 $ = 18.9908° 
inv 0^ = .0127 
cos 0 . = .9451 


0 ^ = arc cos 


0, « .3330 rad. 


(|R) g 2 - (0R)p 2 - C0 : 


2C0(0R) p 


0 6 = 18 . 1207 C 


0-j = arc cos 


(ir) g 2 + CO 2 - (or) p 2 
2 CD ( I R) g 


0 7 * 6.9746° 


= arc cos .9504 (eq. 23) 
0 ^ = .3163 rad. 

■ arc cos .9926 (eq. 24) 
0 7 = .1217 rad. 


For no tip interference 

Y 

Where 

X = CD(sin0j - 0|cos0j) + (BR)p(0fc + inv 0^) (eq. 25) 
Y = (BR) g ^0 7 + inv 0 2 J (eq. 26) 

X = .6073 
Y = .5955 

Since Y there will not be any tip interference. 

M, Measurement between pins: 

For T, = .0617 ; 2 r, = 9.4286 ; 0 = 20° 

inv 0 = .0149 ; N * 264 ; 2x » .0686 
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inv 0g = ( if /N) + inv 0 - (T|/2rj) - x/(rjcos0) (eq. 27) 
inv 0g = .01252 0 8 = 18.9058° 

M 5 = (2 r |COS0)/cos0q - 2x (eq. 28) 

M 5 = 9.2967 

For T, = .0607 ; inv 0 8 = .01263 ; 0 8 = 18.9574° 

M 5 = 9.2996 

Measurement between pins 9.2967/9*2996 with .0686 diameter pins. 


Gear calculations are summarized in TABLE 5. 
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APPENDIX C 


PITCH YAW JOINT ROLLER-GEAR DRIVE GEAR DATA 


Specifications for the Pitch 

Nominal ratio 
Output torque 
Dual input torques 
Maximum size 


Yaw Joint drive were: 

3.43:1 

186.5 Nm (1650 in. lb.) 
27.1 Nm (240 in. lb.) 
no larger than ORNL LTM 
large P/Y Unit 


Gear Stresses 

Input torque to each bevel roller-gear = 240 in. lb. 

Bevel pinion P.D. = 1.75 in. 

Bevel gear P.D. = 6.00 in. 

First reduction ratio = 6/1.75 = 3.4286 

Second bevel reduction ratio = 1 

Output torque, first stage bevel reduction = (240) (3.4286) 
Total output torque = (823) (2) = 1646 in. lb. 

Select for bevel pinion P = 1 6 , 20° pressure angle 
Then 


N p = 28 

N g = 96 

Select face width f = .31 in. 


F t = (240) (2) /I .75 = 274.3 lb. 

From standard gear design texts 


Bending stress: 


W K s K m 
K v f J 


(274.3) (16) (,5) (1.1) 
(1) (.31) (.318) 

24,500 psi 


OK 


P 

Ko = 

Kv = 


= 16 

= 1.0 

1 .0 


K m = 1 


K s " 
J = 


0.5 

0.318 


823 in. lb. 


C-l 



Compressive stress: 


P 

2800 


/ FjCq 

{ C f 


( 's ( 'm c f 


d I 




(274.3)0.1) 


Select P = 12 


Then 


20° pressure angle 


C,-\ — C > 


.30(1. 75) (. 104) 
s c = 204,800 psi 

Use A I S I 9310 steel, case hardened to R c 60-62 
For second stage 

Bevel pinion P.D. = 3.25 in. 

Bevel gear P.D. = 3.25 in. 


N P = 39 

N G = 39 

Select face width f = .50 in. 

F t = (823) (2)/3„25 = 506.5 lb. 


Bending stress: 


(506.5) (12) (.54) (1 . 

(.50) (.270) 


11 


26,740 psi 


P 

K, 


C s = Cf 
2800 
1.1 
1.75 
. 104 


m 


12 

1 

1 

1.1 

.54 

.270 


= 1.0 


Compressive stress: 


S 


c 


2800 


I (506.5) (1.1 ) 
y/ (.50) (3.25) (.07) 


S c = 196,000 psi 



~s 

= 2800 
= 1.1 
= 3.25 
= .070 


Use AISI 9310 steel, case hardened to R c 60-62. 


1 .0 


These stresses are acceptable for hardened steel gears. The loading 
is too high for soft metallic or non-metallic gears. This is in contrast 
to the low torque Wrist-Roll drive in which non-metallic gears could be 
used . 


C-2 



Gear Forces 


After executing a layout, mean P.D.'s of the gears were determined 
by measurement for calculation of reaction forces. 


Fi rst stage: 

Mean P.D. of gear = 5.68 in. 

F = 182.3] (?1 . 28 g.8 Ib . 

5 . 68 

Bevel gear angle 

tan oC = 6.00/1.75 = 3.4285714 

oC = 73.7397950° 

Separating force 

F $ = 289.8 tan 20° = 105.5 lb. 

Radial reaction 


T g = F s sin ©C = 101.3 lb. 

Axial reaction 


Tp = F s cos oC = 29.5 lb. 

Second stage: 


Mean P.D. of gears = 2.88 in. 



(823) (2)/2.88 

= 571.5 lb. 

45° 


571.5 tan 20° 

= 208 lb. 

208 sin 45° 

= 147 lb. 

208 cos 45° 

= 147 lb. 


These forces are used in final design for computation of bearing loads 
and structural deflections. 


To summarize the gear data, all gears are 20 pressure angle standard 
involute A1SI 9310 steel, case carburized to R c 60-62. These data are shown 
in Tables 8 and 9. 



APPENDIX D 


SOFTWARE FOR PITCH YAW JOINT 


NASA I.C 
NASA 2,C 
NASA 3.C 
NASA 4. C 
NASA 5.C 
NASA 6.C 
NASA 7.C 
NASA 8. C 
NASADATA „H 
EXTDATA.H 
NASADEF.H 
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/ # * # $ t # # # # # # # ijt # $ # 4? # # $ # 3fc # 'A $ 

# FILEs NA3A1.C 

# DATE; July 28, 1990 
& 

# ROUTINES 

# S y s t e m_ S t a r t u p 

# System_Shutdown 

¥ Rest art_Operat ion 

$ F'arameter_Qperat i on 

# Ou i t__Op e r at i on 

# Select_Fu.nct .ion 

# main 

# 

% 

% % % % % ######## % # % % % % % % % # # % / 

# include "extdata.h" 

#inc 1 u.d e " n asadef . h " 
#include <dos.h> 

# include <conio.h> 

# i n c 1 u d e < stdio. h > 


% perform the initial startup of the system cards in a safe and 
% k n a w n c o n d i t i o n a n d at 1 1 mo t o r s 1 o c k e d- 
# %%%%%%% % % % % % # # % % t # % 1 1 # # / 

v o i d S y s t e m S t a r t u p ( v o i d ) 

.r 

Set_AD_Card ( } ; 

L o c k_ B r a k e s ( ) 5 
Load_Parameters ( ) p 

MPTR~>py . old_p i tch = MPTR~>sp . p i. tch_neutral ; 
MPTR->py.old_yaw — MPTR~>sp . yaw_neut ral p 
MPTR->ma . res_r ev - 0; 

MPTR->mb . r es_rev = 0 p 
text co I or (WHITE) ; 
t e x t b a c k groLtn d ( E< L A C K ) p 
clrsc r ( } ; 

/# for testing only REMOVE FOR OPERATION#/ 

/# MPTR->py ■ p i tch_pos = MPTR— >sp.pitch_neutral ; 

MPTR~>py , yaw_pDS = MPTR->sp » yaw_neutral p #/ 


J % % % % # % % t % % % '4: t # % % % # # % % % % % 

% perform the system startdown 
% % % t # # ###### # # # # # # # # # # # # / 


void System Shuitdown ( vo i d ) ORIGINAL PAGE IS 

OF POOR QUALITY 

S a v e_ P at r at rn e t e r s ( ) p 
t e x t c a I o r ( WH I TE ) p 
textbackgro u n d ( B L A C K ) ; 



/ 1 tttt 1 1 1 1 1 % 4 % t if. tt%% t 
$ restart the system operating program 
t if >jc # t # t # 1 1 $ ¥ t $ % t % %%%%*%% / 

^void Restar t_Oper at ion ( void ) 


Set_At>__Car d ( ) ; 
Load_Parameters( ) ; 
ERROR_FLAG = RESET; 

D i sp 1 ay_Er ror ( TRUE ) ; 


/ if. 1 1 1 % 1 1 if if if? t $ if # $. t & % % t % 1 1 if 
if function to display system data, 
$ setpoint values and gain vail Lies 
1 1 1 if # t ¥ 1 ¥ % % t %% t if ¥ 1 1 ¥ ¥ ¥ ¥ ¥ / 


void P a r a\ m e t e r __ 0 p e r a t i o n ( v old) 
\ 

i n t don e_f 1 ag ; 


done_flag - FALSE; 
wh i 1 e ( ! done_f 1 ag ) 


textcolor ( BLACK ) 5 

t e x t b a c k g r o u n d ( W H I T E ) ; 

f lushal 1 ( ) ; 

g o t o y ( 20 , 1 5 ) ; 

print -f( " 

gotoxy ( 2.0 ,15); 

printf(" D -'DISPLAY SYSTEM DATA 
gotoxy ( 20 , 16) 5 

printfC S - DISPLAY SYSTEM SETPOINTS 
gotoxy (20, 17 ) 5 

printf(" G - DISPLAY SYSTEM GAINS 
g o t o x y ( 2 0 1 8 ) 5 
printfC E -EXIT 
gotoxy ( 20 , 20 ) ; 

printf(" Enter In Desired Operations 

g o t o x y ( 5 0 , 2 0 ) 5 

switch ( toupper ( getche( ) ) ) 


" ) 5 
" ) 5 
") 5 
" ) 5 
" ) 5 
" ) ; 


case ’ D ? s Disp 1 ay_System_Data ( ) ; 
case J S ■’ s Display_System__Setpaints( ) s 
case ’G’ s Disp 1 ay_System_Gains( ) ; 
case ’Ed's done__flag = TRUE; 
defaults break; 


b real: ; 


break 

b r ea k 
break 


textcolor ( WHITE ) ; 

textbackground ( BLACK ) s 

gotoxy ( 20 ,14); 

c 1 reo I ( ) ; 

gotoxy ( 20 , 15 ) ; 

c I reo 1 ( ) ; 

gotoxy ( 20 ,16); 

c 1 reol ( ) ; 

gotoxy ( 20 ,17); 

c 1 reo 1(); 

gotoxy ( 20 ,18); 

c. 1 reo 1 ( ) ; 


gotoxy ( 20 , 20 ) s 
cl real ( ) ; 


% % If. % t 1 1 % t % t # 

t does system shutdown 
% will save system parameters 
* given the OK 


# * t % # % %%%%%%%% t % t %*%%%%* / 


i f 


void Qui t_Gper at ion ( void } 

D i sab 1 e_AD_ Inter rupt ( ) 5 
System_Shutdown ( ) 3 
OPERATE = FALSE § 


t displays the command options 
t % & $ # # & % & % % % % % % % % 1 1 $ ¥ t / 


v o i d S e 1 e c. t _ F u n c t ion ( v aid) 

'L 

int loop; 


■for (loop 0 5 loop < 30 ; ++ 1 oop ) 

Get_.Joint_Dat a ( ) 5 
t e x t c o 1 o r ( BLACK ) s 


t e t b a c k ground(WHITE) ; 
got. ox y ( 40 , 24 ) 5 
cputs ( "CONDITION " ) 5 
gotoxy ( 1 ,, 1 ) 5 
c I real ( ) 5 
gotoxy (17,1); 

cpu.ts ( " NASA LeRC - TRANSMISSION RESEARCH TEST 
gotoxy ( 50 , 24 ) ; 

cputs ( " ’ " ) 3 

gotoxy ( 1 22 ) ; 

cputs ( "PITCH ANGLE = " ) 3 

gotoxy ( 3. 5 , 22 ) ; 

pr intf ( "% . 2f " , MF'TR->py . p i tch_ang ) ; 


gotoxy ( 1 , 23 ) ; 
c p u.t s ( " YAW ANGLE 
gotoxy ( 1 , 24 ) 3 
cputs ( "BRAKES s 
Lock__Brakes ( ) : 
g o t o x y ( 1 5 „ 23 ) 3 

printf ( "”/.. 2 f " , MPTR->py .yaw_ang ) 


" ) 5 
“ ) ; 


gotoxy ( 20 , 4 ) 5 
cpr intf (" R - 
gotoxy (20, 5) ; 
cpr int-f ( ” S -- 
gotoxy (20, 6) ; 


RESTART THE SYSTEM 


SINGLE COMMAND INPUT 


cpr intf (" M •- MULTIPLE COMMAND INPUT 
gotoxy ( 20 „ 7 ) ; 

c p r i n t f ( " ' J - JO YST I CK SYSTEM 0PER AT I ON 


gotoxy ( 20 ,8)3 
cprintf(" N ■ 


gotoxy ( 20 , 9 ) ; 
cprintf(" P - 
gotoxy ( 20 , 10 ) 3 
cpr intf ( " E - 


g ot o x y ( 20 , 1 2 ) ; 


MOVE TO NEUTRAL POSITION 
SYSTEM PARAMETER GREAT I ON 


EXIT 


cpr intf ( " Enter In Desired Operations 


gotoxy 1. bo , 1 


CENTER" ) 


" ) 5 

" ) 5 
" 3 - 

/ 9 

H \ a 

. !» 

" ) 5 

" ) 5 
") § 
") 5 


p/\Q£ es 

OF POOS QUALITY 


5 wi ten f, toupper ( getche ( ) ) ) 

Restart_Oper at i on ( ) 5 break; 
Command_Operat ion ( ) ; break.; 
M__Command__Qperat ion ( ) ; break 

Joyst ick_Operat ion ( ) ; break; 
Neutral_Operat ion f ) ; break 5 

F'arameter__Operat ion < ) ; break 

Qui t_Qperat ion ( ) 5 break 

de-faults break; 

textcolor ( WHITE) ; 
textbackground ( BLACK ) ; 


void mail n (void) 

OPERATE = TRUE; 

System„St art u.p ( ) ; 

while (OPERATE) Select__Funct ion ( ) 3 
Sys.tem._Shut.down ( ) ; 


’R 
? S 
■’ M 
" J 
•’ N 

’ p 

case •" E : 


case 

case 

case 

case 

case 

case 



# 


t 1 1 t t % t % % 1 1 % t % % % >R * t 
FILEs NA5A2.C 


# 

% 

% 

% 


DATE 


F u 1 y 28, IwO 


t 

% 

t 

% 

* 

t 

# 


ROUT I NES 
T i mer 
Set_ Clock 
Unset_C 1 oc k 
S e t _ A D__ C a r d 
Lock_ Brakes 
U nloc k__ B r a k e s 
Enab 1 e_AD_ Inter ru.pt 
D i s ab 1 e__ AD_ 
Read_AD_Channe 1 
Read Resolvers 


t 

# 


Get Joint Data 


# # # # # 1 5?< I {ole*######## # # # # # t % / 


# include "extdata.h" 

# i n c 1 ud e " n asad ef h " 
#i no 1 tide < d o s . It > 

# i n elude < conio.h > 

# i n c 1 u d e < s t d i a . h > 


/ # % % t % % % % # % t # * & % ## # 1 # $ t # t 
% g 1 a b a l v a r :L a b 1 e s 
$ # % # t % % # % % % % % # 1 # # 1 1 i< % % % / 
float pitch_new, pitch_old; 
■f .1 o a t. y a w__ new, y a w__ o 1 d ; 

-F 1 o a t r e s_a_ne w , res_ a _ o 1 d : 
float, res b new, res b olds 


/%%%%% % % % # % t % % t % % % * # % # * % % 
t save the address of the printer 
t i n t e r r u p t v e c t o r f a r r e p 1 a cement 
# ####*################## / 


void interrupt ( 


>Koldhandier ) ( void ) s /Ivector of interrupt routine 
that will be replace for A/D clock#/ 


/ % % % # t %%%%%%%%%%%%%%%%%%% 

t this is the new interrupt handler, on interrupt the flag START__LOQP 
# is set, the program monitors the flag for sync operation 
##$### ft#################/ 


'aid interrupt l imer 


■ id) 


d i sab 1 e ( ) ; 

START_LOOP = TRUE? 
o u t p o r t b ( A D_ STATUS. CL. R_ I N T ) ?, 
o u t p o r t b ( 0 x 0 0 2 0 , 0 2 0 ) ; 
enab le ( ) ; 


/^enables A/D bd interrupt#/ 
/ % r e s e t i n terrupt c h i p % / 


Y replace the printer interrupt handler with the above handler 

Y Y Y if % Y t YYYYYYYYYYYYYYYYY/ 


void 


S'et_C 1 oc k_Up ( vo i d ) 

START_LOOP = FALSE 5 
oldhandler = getvect i INTR_LOC ) ; 
setvect ( INTR_LOC , Timer); 


/ Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y 

Y return the printer handler to the interrupt vector location 
YYYYYYY YYYYYYYYYYYYYYYYY/ 

vo i d Unset__C 1 oc k (void) 

r 

L 

START__LOQF' = FALSE; 
o u t p o r t b ( A D__ C 0 N , I N T__ OFF) ; 
setvect ( INTR__LOC, oldhandler) ; 


/ $ t % % % % % % %% % Y % % % % % % %%%%%% 

Y set up the A/D -- D/A card 
%%%%%%%%%%%%%%%%%%%%%%%%/ 


•or 


initial operation 


v o i d S e t A D . C a r d ( v o i d ) 


en %/ 
en %/ 


int temp , low, high; 
unsigned char value; 
outpor tb ( AD__CC3N I MT_OFF ) ; 
o u t p o r t b ( A D__ S C A N ,, 0 0 0 ) ; 
out port b ( A dIbTATUS , CLR_ INT ) 
o u t p o r t b ( D A 0_ L 0 W , 0 x 0 0 ) ; 
o u t p o r t b ( D A 0_ HI, 0>c80); 
o u t p o r t b ( D A 1 _ L 0 W , 0 x 0 0 ) ; 
o u t. per" t b ( D A 1 __ H I , 0 x 8 0 ) ; 
outportb ( I0_0UT , L0CK_B ) ; 
o u t p o r t b ( A D__ T I ME , 0 0 1 ) ; 
outportb ( AD_GAIN, 6 AIN_i ) ; 
outportb ( ADc_C0N , 0xb4 ) ; 

outportb ( ADc_C0N , 0x74 ) ; 

outportb ( AD_CNTR_2 , 0x14) ; 
o u. t p o r t b ( A D_ C N T R_ 2 , 0 x 0 0 ) ; 
temp = 50000 / FREQUENCY; 
high - temp / 256; 
low ~ temp -■ (256 % high); 
outportb ( AD__CNTR_ 1 , .1 ow ) ; 
outportb ( AD_CNTR__1 ,, h igh ) ; 
p i t c h_o Id = MPTR-- > sp « p i t c h 


/ Y c. 1 e a r 
/ % s e t D / A * s 


/Yon e channel 
any interrupts 
t o mid range Y / 


scan#/ 


' fallow co u n t e r s 1 2 t o c o u n t % / 


/ % c n t r 2 , 
/ lentr 1 ,, 


r /1 low then high byte, 
r /1 low then high byte. 


/Yload counter two with 20 
/% A/D internal clock is 1000000 Hz 
/ % 1 000000 / 20 = 50000 using -freq, 
/Ynow -find the low & high bytes -for 
/Ycounter one and load these in 
/Ysee A/D manual 
neutral ; 


rate g 
rate q 


t / 
%/ 
*/ 
%/ 
%/ 
%/ 


y a w_ old “ M K T R -• > s p . y a w_ n e u t r a 1 ; 


/ Y Y $ t Y t Y Y Y % % %%%%%% >1; % % % % % % 

% lock the motor brakes 
% Y % % Y % % % t Y Y Y Y Y Y Y Y Y Y Y Y Y Y Y / 


void L o c k_ B r a k e s ( v o i d ) 


outportb ( I u_OU1 , LOCK_B ) ; 

MF'TR— > ma „ mot_d r i ve — 2048 ; 

MF‘TR->mb ■ mot_dr i ve = 2048 ; 

Motor_Dr i ve ( ) ; 

t e x tcQlo r ( BLACK ) ; 

t e x t b ac k g r oun d ( WH I TE ) ; 

gotoxy ( 1 0 , 24 ) ; 

cputs ( " " ) s 

gotoxy ( 1 0 ? 24 ) 5 

cputs ( " LOCK " ) r, 

sound { 800 ) 5 

del ay ( 50 ) ; 

nosound ( ) ; 


t u n 1 o c: k t he motor b r a k e s 
$ # %*%%%%%%%%%%%/ 

v oid Uni o c l<_ B r a k e s ( v o i d ) 

\ 

MF'TR->ma . mot_ d rive = 2048 5 
MPT R - > m b „ m o t _ _ drive = 2 0 48; 
i v lotor_Dr i ve ( ) 5 

out p o r t b ( i clout , unlock__b ;> ; 

t e x t c o 1 o r ( BLACK ) ; 
t e x t b a c k g r o u n d ( W HITE) ; 
gotoxy ( 10 ,24 ) ; 

(inputs (" ' " ); 

gotoxy ( 1 0 , 24 ) ; 

cputs ( " UNLOCK " ), 

sound ( 400 ) ; 

del ay (50 ) 5 

nosound ( ) 5 


/ t % $ t # $ # 1 1 1 $ t * t i< % * $ t # % % t # 
t enable the A/D interrupts -for sync operations 
# 1 1 1 -i< 1 1 # # & i< 1 1 1 t # # $ # # t * % / 

v oid Ena b 1 e__ A D__ I n t e r r u p t ( vo i d ) 

r 

L 

outpor tb ( AD_C0N , I NT__QN ) 5 
outportb ( AB__ STATUS , CLR__INT) ; 
enab 1 e ( ) ; 


/ % % % $ # # H % #%%%%%%%%%%%%%%% 
t disable the A/D interrupts for sync operations 
%%%%%%%%%%%%%%%%%%%%/ 

void D i s a b 1 e__ A D_ I n t e r r u p t. ( v o i d ) 

\ 

outportb ( AD_C0M , IMT_0FF ) ; 



t read the value out. o-f an A/D channel 
%%%%%%%%%%%%%%%%%%%%%%%%/ 

i n t. R. e a\ d_ A D__ Chan ( channe 1 ) 

unsigned char channel; 



/# 


int loop 3 

unsigned char low, high; 
unsigned short raw; 
int data; 


out port b ( 0x332 , channel ) ; 

-For (loop = Or, loop <= 1; ++ 1 oop ) j 
o u t p o r t b ( 0 3 3 0 , 0 x 0 0 ) ; 

■for (loop = 0 ; loop <= 2 ; ++loop); 
low = inportb (0x330 ) ; 
high = inportb (0x331 ) ; 

raw - ((((high << 8 ) + low) >> 4) 0 OxOfff); 

data = (int) raw — 2048? 

got ox y ( 40 , 23 ) 5 

c 1 reol ( ) ; 

g ot oxy ( 40 , 23 ) 3 

j. HF ( c h a n n el = = 0 x 0 0 ) 


printf("ch Y.y, 
d e 1 ay i 1 0 ) 3 


return data 3 


raw %x data = V. d", 
test only#/' 


channel , 


raw, data); 


/ # # # # % # # % # # % % $ X # % %%%%%% % % 

% The the six channels of the resolvers 
# c h e c k -F o r e r r o r con d i t i a n s 

% on pitch and yaw, read the xl and x 1 6 channels 
X and •find the final value 
X X # # # # # X t ######## X X X X X # X / 

void Read_Resolvers( ) 

L 

unsigned char error, count, low__b, high__b; 
unsigned short xl, xl 6 , temp_xi, temp_x . 1. 6 3 
static unsigned int ma__res__old - 32768; 
static unsigned int mb_res_old = 32768; 

outportb ( BASE , M__A_R) ; /Iread motor A input resolver#/ 

low_b - i nportb ( LSB ) 3 
h i gh__b - inportb ( MSE< ) ; 

xl ~ (high_b X 256 - 1 - low_b) & OxfffO; /#12 bits#/ 
if (xl < 49152) xl = xl +’ 16384; 
else xl = xl ~ 49152; 

MPTR~>ma. res_cnt = xl; 

if ( (ma_res_old > 65280) && (MPTR— >ma . res_cnt < 256)) MPTR— >ma . res_rev + 

else if ( (ma_res_Dld < 256) && (MPTR— >ma. res_cnt > 65280)) MPTR— >ma . res_ 
1 ; 

m a. _ r e s_ old - M P T R - > m a . r e s_ c n 1 3 

outportb ( BASE , M_B_R); /tread motor E- ; . input resolver#/ 

low_b - inportb (LSB) ; 
h i. g h__b — i n p o r t b ( MS B ) ; 

xl = (high_b X 256 + low_b) 0 OxfffO; 
if (xl < 49152) xl = xl + 3.6384; 
else xl = xl - 49152; 

MPTR— >mb . res_cnt = xl; 

if ((mb_res_old > 65280) &.'(■' (MPTR— >mb . res_cnt < 256)) MPTR— >mb . res_rev + 
else if ( (mb_res_old < 256) ( MPTR— >mb . res_cnt > 65280)) MPTR— > mb „ res_ 

1 J1 

fnb__res__old = MPTR— >mb . res_cnt ; 

outportb(BASE, P_LD ) 3 /tread pitch resolver Xl windings#/ 

1 o w b = i n o o r t b ( L S E-f ) ; 



S * , 


h i gh_b -• i npor tb ( MSB ) ; 

x 1 = (high_b * 256 ■+• low_b) & Oxfffc; /*get 
if (xl < 49152) x 1 = x 1 + 16334; 
else xl — xl - 49152; 

out p o r t b ( BASE 5 P_H I ) ; / * ( not used ) r ead 


14 bits*/ 

/* ad just for 

pitch resolver 


offset */ 

X16 winding 



/* 

/* 


f i n a 1 
/* PUT 


low_b = inportb ( LSB) ; 
h igh_b — i npor tb ( MSB ) ; 

xl 6 = (high_b * 256 + low_b) 8 < Oxfffc; 

temp_xl = xl OxOfOO; */ /*check for section boundary's*/ 

temp_xl 6 = :-;16 ?< Ox f 000; 

if ((temp_xl >= OxOeOO) && (temp_xl 6 <= 0x2000)) xl = xl + 0x1000; 
else if ((temp_xl <= 0x0200) %>.%■•. (temp_xl 6 >-- OxeOOO)) xl - xl - 0x1000; 
MPTR-->py , p itch_pos = (xl 8 < OxfOOO) ! ((xl 6 ?< OxfffO) >> 4); % / / * f i n d 

result*/ 

IN FOR REAL OPERATION*/ 

MF'TR“>py .pitch pos = xl; /*find final result*/ 


outpor tb ( BASE , Y_LG); / * read yaw resolver Xl windings*/ 

low_b = inportb (LSB) ; 
h i g h_ b i n p o r t b ( MS B ) ; 

xl - (high_b * 256 + low_b) & Oxfffc; /*get 14 bits*/ 

if (xl < 49152) xl = xl + 16384; /*adjust for offset*/ 

else xl = xl - 49152; 

/* outportb ( BASE Y__HI);*/ /Knot used ) read yaw resolver X16 windings*/ 

/ * 1 o w__ b = in p o r t b ( L SB) ; 

high_b = inportb (MSB) ; 

x !6 ~ (high__b # 256 + low_b) & Oxfffc;*/ 

/* temp_xl - xl ?< OxOfOO; */ /*check for section boundarys*/ 

/* temp_xl 6 = xl 6 OxfOOO; */ 

/* if ((temp_xl >== OxOeOO) 8 < 8 < (temp_xl 6 <== 0x2000)) xl xl + 0x1000; 

else if ((temp__xl <= 0x0200) §•:& (temp_xl 6 > = OxeOOO)) xl - xl -- Oxl 000 5 * 

/ 

/* MPTR— >py . yaw_pos = (xl OxfOOO) I ((xl 6 OxfffO) >> 4);*/ /*find f 

inal result*/ 

/ *PUT IN FOR REAL OPERATION*/ 

/* yaw_new = 0.0 * yaw_old + 1.0 * (float) (x'i); 

•y a w_ old == y a w_ n e w 5 

M P T R — > p y , y a w_ p o s - ( i n t ) ( y a w_ n e w ) ; * / 

M P T R -- > p y » y a w__ p o s = x 1 ; 


MPTR- 

- > m a . r e s__ a n g ~ 

360 . 0 * 

( f 1 oat ) ( MPTR—) 

►ma . res_cnt ) 

/ 

65536 O ; 

MPTR- 

->mb „ res__ang = 

360 . 0 * 

(float ) (MPTR-!: 

mb . res_cnt ) 

/ 

65536 „ 0 ; 

MPTR- 

->py . p i tch__ang — 

( 360 . 0 * 

( f 1 oat ) ( MPTR- 

->py . p i tch_pos 

— M P T R - > St p . p i t c 

neutrai ) / 

65536 . 0 ) ; 






MPTR- 

- > p y . y a. w_ a n g = 

( 360 . 0 * 

(float) (MPTR- 

->py . yaw_pos 


... MPTR~>sp . yaw_ 


neutral) / 65536.0); 

if ( MPTR—>py . p itch_ang > 180.0) MPTR->py . p i tch_ang - r - 360.0; 
if ( MPTR—>py . yaw_ ang > 180.0) MPTR— >py . yaw_ang — = 360.0; 


/ * * * * * * * * * * * * * * ****** * * * * 

* collect the joint data 
* * * * * * * * * * * * * * ********** / 

vo i d Get_ J o i n t_Da t a (voi d ) 


int loop; 
int temp a, t. 
int torq__Ioo! 


and store away 


OR&INAL PAGE 53 

OF POOR QUALITY 


/* PUT 


o u tpor t b ( A D_ C 0 N s A D_ s E T ) ; 
outportb ( AdIsTATUS, CLR_INT) ; 

IN FOR REAL OF'ERTION next 6 lines */ 


63 


MPTR— >ma « tach = Read_AD_Chan ( AD_TACH__ A ) 5 

MPTR— > mb . tach = Read_AD_Chan ( AD_TACH_B ) 5 

MPTR— >ma . res_vel = Read_AD_Chan ( AD_RD_V_A) ; 

M P T R - > mb . re s_ vel = R e a d_ A D__ C h a n ( A D_ R D_ V_ B ) r, 

MPTR— >py . p i tch_vel = Read_AE>__Chan ( AD_RD_V_P } 5 
M P T R — > p y „ y a w__ v e 1 = Read_ A D_ C h a n ( A D_ R D__ V_ Y ) ; 

outportb ( AD_GAIN ? GAIN_ 500 ) 5 
Read_Resa I vers ( ) ; 

/#test only next four lines#/ 

MPTR— >py . p .i tch_vel = ( int ) (MPTR->py . p i tch_pos - MPTR— >py „old__p itch ) 

MPTR->py « yaw_vel - ( int ) (MPTR->py . yaw_pos - MPTR— >py » o 1 d_yaw ) 5 

MPTR->py „ o 1 d_p i tch = MPTR— >py . p i t. ch_pos 3 

MPTR— >py .old_yaw = MPTR— >py u yaw_pos 5 

temp a — O5 

tempb = 0; 

for (loop = 0; loop < torq_loop; ++loop) 

tempa. - Read_AD_Chan ( AD_TQRQ_A) + tempa; 
for (loop - 0 ; loop < torq_loop; ++loop) 

temph - Read_AD_Chan ( AD_TORQ_B ) + tempb 5 
ou.tportb ( AD__GAIN ? GAIN_i ) j 

M P 1 ‘ R > m a . t o r q = (int) (tempa / tor q_ 1 00 p ) 3 
MPTR->mb . torq = (int) (tempb / t orq__ 1 oop ) 5 
E n a b 1 e___ A D_ _ I n t. err u p t ( ) 5 




/ft############## 1 t % %%%t % % t 

# FILES NASA3.C 

# DATEs July 28. 1990 
% 

# ROUTINES 

# In it ial_System 

# D i sp 1 ay__Er roe 

# Mo t o r_D rive 

% D a t a _ R e c o r d 

t Data__Save 

t L.oad_Parameters 

# Save_Parameters 

# 

# $ # # # jfs $ $ # # # & $ # # # # # # # # # # # / 

# i n c 1 ud e " e t d a t a . h " 
#include "nasadef . h " 

# i n c I u d e < d o s .. h > 

# i n c 1 u d e < conic. h > 

# i n c 1 u d e < s t d i o . h > 


/ # * % %%%%%%%%%%%%%%%% % * # % % 

% routine to set up system -for arm motion 
% % % % # % % % %%%%%%%%%%%%%%%% / 

Vo i d I n i t i a l_Sy st era ( vc i d ) 


/% for 
/ # 


RUN_ARM = TRUE ; 

ERROR... FLAG = FALSE; 

MPTR- > sp . s 1 i m i t_p itch = FALSE; 
!iPTR->sp «sl imit_yaw — FALSE; 
M P T R - > m a m o t_ d r ive - 2 0 4 8 ; 
MPTR- >mb „ mot_d r i ve = 2048 ; 

M P T R -- > ds.cou n t e r = 0 ; 


L0G._CN ! = 0 ; 
L0G_REV = FALSE; 
testing only#/ 

MPTR— >py . p i tch_ve 1 
MPTR- >py . yaw.._ve 1 
M P T R -• > m a .. t a c. h 
MPTR->mb . tach 

Mot o r_ I n i t i a 1 ( ) ; 

* 1 . 

J 



- 2048; 

= 2048;*/ 


/ 1 * 1 1 # # % % % % % % t * * 1 1 * ###### 

% routine to display the 
$ ' 4 ; # % # >f. # % % t % % t # # # t >y. # t # 1 1 / 


reason for the syst 


em 


void Display_Error ( int flag) 

r 

i 

if fflan — 


shutdown 


TRUE ) 


qotoxy ( 50 , 24 ) 5 
else gotoxy ( 25, 18 ) 5 
tejitcolor ( BLACK ) ; 


teKtbackground ( WHITt ) 


i 4 f ERROR FLAG 

else i f (ERROR 
i f 
if 


else 
e 1 se 
e 1 se 
else 
e 1 se 
e 1 se 
else 
else 
else 


i f 
i f 
if 
i f 
if 
i f 


f ERROR. 
( ERROR 

( error’ 

( ERROR. 
( ERROR. 
( ERROR. 
( ERROR. 
( ERRuR 


sound ( 500 ) 
delay ( 100 ) 
nosound ( ) ; 


HI 


FLAG 

FLAG 

FLAG 

FLAG 

FLAG 

FLAG 

FLAG 

FLAG 

FLAG 

FLAG 


.LIMIT) cputsf "PITCH LIMIT - HIGH")? 
P_L0_LIMIT ) cputs( "PITCH LIMIT - LOW" ) ; 
Y_HI_LIMIT) cputs ( " YAW LIMIT - HIGH " ) 5 
Y_LQ_LIMIT) cputs ( " YAW LIMIT - LOW”); 

R E S 0 L V E R_ ERROR ) cputs ( " RESOLVER ERROR " ) ; 
IMORMAL_SHUTBOWN) cputs ( "NORMAL SHUTDOWN") 
RESET ) cputsf" RESTART I MG COMPUTER " ) 5 
S0FT_L I M I T_P ) cputsf "PITCH SOFT LIMIT"); 
S0FT_L I M I T_ Y ) cputsf "YAW SOFT LIMIT " ) 5 
TIME_0UT) cputsf "TIME OUT ERROR”); 
AD.FAIL) cputsf "AD INTERRUPT FAIL"); 


/ttt t t tttt t ^ t t t t t t t y % tt % t 
% output values for motor drive 
% check for proper range of values 
* % % % * t % #####* # % % t % * % % t t # / 

void Motor_Dr i ve f void ) 

.r 

unsigned int temp_a, temp_b; 

unsigned char hi_a, la^a., hi__b,, lo._b; 

if ( MPTR— >ma . mot__dr i ve > 4095) MPTR— >ma«mot_dr ive 4094; 

else if ( MPTR- >ma»<not_d rive < 0) MPTR->ma . mot._dr i ve = 0; 
if ( MPTR->mb . mot_dr i ve > 4095) MF'TR->mb . mot_dr i ve == 4094; 

else if ( MPTR— >mb »mot__dr ive < 0) MF‘TR->mb. mot _d rive = 0; 
temp_a = (MF*TR->ma.mot_drive << 4); 
hi_a - f ftemp__a & OxffOO) >> 8 ); 
lo_a (temp_a ?•< OxOOff); 

temp_b = (MPTR->mb . mot_dr i ve << 4); 
hi_b - f(temp_b ?< OxffOO) >> 8)5 
lo._b = (temp_.b §< OxOOff); 
outportb f DA0..L.0W , 1 o__a ) ; 
o u t p o r t b f D A 0._ H I , h i _ a ) ; 
outportb f DA1_L.0W , lo_b ) ; 
a u t p a r t b f D A 1 _ H I , I - ', i _. b ) ; 

ft printf("lo hi a-b %x 7.x %x 7.x\n 11 , hi_a, lo_a, hi__b» lo_b); 


/ %%%%%%%%%% % % % % %%%%%%%%%% 

% routine to record joint data far later display 
%%%%%%%%%%%%%%%%%%%%%%%%/ 


voi d 



D a t a_ R e c o rdf voi d ) 

r 

1 og_tach_a [ L0G..CNT ] 


MPTR->ma .tach ; 


1 og_ 

_tach__b L 

LOG CNTj = 

MPTR: -> mb . tach ; 


1 og_ 

_torq_a[ 

LOG _CNT J = 

M P T R - > m a „ 1 0 r q ; 


1 og_ 

_torq_b [ 

L0G_CNT ] = 

M P T R -• > mb.torq; 


1 og_ 

_res_cnt 

_a [LQG_CNT j 

= M P T R — > m a.re s_ 

cnt ; 

log. 

.res_cnt 

b [LOG CMT 1 

= MPTR- > m b.re s_ 

_cnt ; 

log. 

res rev 

at LOG CMT] 

= M P T R - > ma.res. 

.rev ; 

log. 

_res_rev 

b [LOG CNTj 

== MPTR— >mb „ res. 

rev ; 


1 og_mot or_cmd._a [ L0G_CNT ] 
1 og_motor_cmd_b [ LQG_CNT ] 
loo oitch dos FLOG CMT1 = 


= M P T R -■ > m a . mot_ d r ive; 
-• MPTR->mb „ mot__d r i ve 5 
M P T R -• > d v , 0 i t c: h d o s s 


s:\jai 


OF 


1 og_.p i t ch_ ve 1 [ LOG_CNT ] = MPTR— >py „ p i tch_ve 1 p 
1 og_yaw_ P os [ LOG_CNT ] = MPTR->py . yaw_pos 5 
1 og_yaw_ve 1 [ LQG_CNT ] = MPTR— >py . yaw_ve 1 p 
iog_desire_pi tch_pos[LOG_CNT] = MPTR->ds.pitch_posp 
log_desi re_yaw_pos[L0G_CNT3 = MPTR— >ds. yaw_pos 5 


L06_CNT - LOG_CNT + i; 
if (LOG CNT == MAX LOG) 


LOG_CMT = 0 5 
LOG REV = TRUE p 


>K routine to save joint data for later display 


vo i d Da t a_Sa ve (voi d ) 

\ 

FILE #param_f i le , #fopen()p 

unsigned int us temp 5 


itemp ; 
f temp 5 

loop, count; 

answer p 

1 og f i 1 en ame [ 1 2 ] 5 


int 
float 
int 
c h a r 
c h a r 

t e t c o 3. o r ( B L. A C K ) p 
t e x t b a c k g r o u n d ( W H I T E ) p 
qotoxy ( 20 15 ) p 

cputs ( "SYSTEM' DATA HAS BEEN COLLECTED 
gotoxy ( 20 ,, 16) p 

cputs ( "DO YOU WISH TO SAVE THE DATA Y/N 

gotoxy ( 60 , i 6 ) 5 

■flush ail 1 ( ) p 

answer = -FgetcharOp 

textco 1 or ( WHITE ) ; 

t e t b a c k g r o u n d ( B L A C K ) ; 

gotoxy ( 20 , 15 ) p 

clreol ( ) 5 ’ 

gotoxy ( 20 ,16); 

clreol ( ) ; 

gotoxy ( 50 , 24 ) ; 

clreol ( ) 5 

gotoxy ( 50 , 24 ) ; 

textcol or ( BLACK ) p 


it ) „ 


:extbac kg round ( WH I TE ) p 


cpu.ts ( “ 
if ( ( answer 


) 


’ Y ’ ) 


( answer 


y ) ) 


textcol or ( BLACK ) p 

t e x t b ac k g r oun d { WH I TE ) ; 

gotoxy ( 20 ,15); 

cputs ( "ENTER IN FILE NAME 

g o t a x y ( 45 , 1 5 ) ; 

■f lush a 1 1 ( ) ; 

scanf ( "%1 Is" logf i lename) ; 
textcolor (WHITE) ; 
t e x t bac k g r o u n d ( B L A C K ) p 
got. o x y ( 20 ,15) ; 

r- 1 ►- f~. n 'i { '1 ? 


" ) 


"w" ) ; 


param_Fi le — F open ( I ogfi 1 ename , 
if (param_f ils == NULL) • 


textcolor ( BLACK ) ; 


textbackground (WHITE ) 
gotoxy ( 50 , 24 ) ; 


cputs ( “FILE ERROR") 
sound ( 500 ) 5 
de lay ( 1 500 ) p 


nosound ( ) ; 
delay ( 5000 ) : 


t ex t co i or ( BLACK ) ; 
textbackground (WHITE ) 5 
got ox y ( 50 , 24 ) 5 
printf ( "WORKING " ) 5 
if ( LOU REV — — FALSE) 


Fpr in tF ( param_fi le , " TACH A 

TORQUE A TORQUE B\n")p 

For (loop = 0; loop < L0G_CNT 5 i oop++ ) 

r 

L 

itemp = log__tach_at loop ] 5 
f temp = (Float. ) itemp '4: 2 .09263 ; 

F p r i n t F ( p a r a m_ F i le , " 7 . d V . F 

temp ) ; 

i temp = log_tach__b [ loop] ; 

Ftemp = (Float) itemp % 2.09263; 

Fp r intF ( par am_Fi le , "7.-F " , 

itemp=log__torq__.a[ loop] ; 

Ftemp = (float) itemp t 0.024414; 

Fp r intF ( par am_f i 1 e , " 7.F " 

itemp = log_torq_h [ loop ] ; 

Ftemp = ( F 1 oat ) i temp % 0 . 0244 1 4 5 
Fp r i n t F ( p a ram_F i. 1 e , " Y.-F \ n " , Ft emp ) 

f pr intf ( par am_f i le , " RESOLVER A 

REV RESOLVER B RESOLVER B REV\n " ) ; 

p 0; loop < L0G__CNT p loop++) 

For (loop-0; loop< L0G_CNT 5 loop++) 
\ 

ustemp = log_res_cnt_a[ loop ] 5 
Ftemp = ( Float ) ustemp * 0.005493; 

Fp r intF ( param_fi 1 e , "%d %f 

op ? Ftemp ) ; 

i temp = 1 og_res_rev_a C 1 oop ] ; 
FprintF(par a m_ F i 1 e , " 7. d 


T ACH a 


, 1 oop , F 


Ftemp ) ; 


ftemp ) ; 


RESOLVER A 
For ( loo 


" , 1 o 


, itemp ) 


ustemp = log__res_cnt__b [ loop] ; 

Ftemp — (Float ) ustemp t 0.005493; 

Fpr intF ( par am_F i 1 e , " %F ", Ftemp); 

itemp — log_res_rev_b [ loop ] 5 

Fpr i ntF ( par am_F i 1 e , "7.d \n", itemp); 


0 MM AND B 


5 Ftemp ) p 


Fpr intF (param_Fi le , " MuTOR COMMAND A MOTOR C 

P I TCH P0S I T I ON P I TCH VELGC I TY\n " ) ; 

For (loop = Op loop < L0G__CNT p loop++) 

itemp = log__motor_cmd_a.r loop] -2048; 

Ft emp — (FI oat ) i t emp # 0 . 004SS3 ; 

Fpr intF ( par am_F i 1 e , "%d 7 . f ", loop 

itemp = log__motor_cmd_b [ loop ] -2048; 

Ftemp - (Float ) itemp t 0.004883; 

fpr intf ( par am_f i le , "XF ", Ftemp); 

1 istemn — Ion nit oh nnq!" • nnn'i 5 



emp ) 5 


ftemp - (f 1 oat Jus temp # 0.005493; 

tpr int-F ( param_f i 1 b 3 "Xf ", Ftemp); 

itemp = log_pitch_vel [ loop] ; 

fprintf (param_t i le , " Xd \n “ , itemp); 

n, 

•fprint-f (param_fi le, " YAW POSITION 

DESIRE PITCH DESIRE YAW\n " ) ; 

for (loop = Os loop < L0G_CNT ; loop++) 

\ 

ustemp log_yaw_posC loop] ; 
ftemp = ( f I oat ) ustemp # 0 . 005493 ; 
fpr intf ( param_f i le , "Xd Xf 

itemp = 1 og_ya.w_vel [ loop ] ; 
fpr intf ( param_fi le , 11 Xd ", 

itemp = log_desi re_p i tch__pos[ loop ] ; 

. ftemp = (float) itemp >k 0,005493; 

fpr intf ( param_fi le , "X f ", ftemp); 

itemp = log_desi re_yaw_pos[ loop ] ; 
ftemp = (float) itemp # 0,005493; 
f p r i ntf (param_f i. 1 e , " ’/„f \n " , ftemp ) § 


YAW VEL0C 


11 9 loop , ft 


/sfctest routines#/ 

/% f p r i ntf ( par am_f i 1 e , "TORQUE A\n"); 
for (loop = 0; loop < L0G_CMT ; !oop++) 

1 

i temp = 3. og_t a r q__a [loop] ; 

fpr intf ( param_f i le, "%d Xd\n" , loop , itemp ) ; 
\ 

f p r i n t f ( par am_f i 1 e , " TORQUE B\n " ) ; 
for (loop =~ 0; loop < L0G_CMT ; loop++) 

\ 

i t emp =- 1 a g_ t o r q__b [ loop] ; 

fpr intf ( param__.fi le , "Xd %d\n", loop ,, itemp ) ; 
> torque test routines#./ 


e 1 S' e 


if ((L0G__CMT — 1) < 0) L0G_CNT = i; 


count = 0 ; 

fpr intf ( param_fi le , " TACH A TACH B 

TORQUE A TORQUE B\n“); 

for (loop = (L0G_CNT - 1); loop < MAX_L0G ; loop++) 


, ftemp ) ; 


temp # 1.348895; 



i t emp = 1 og__t ac h_a [ 1 oop ] ; 
ftemp = (float) itemp t 2.09263; 

7„f " , count , ftemp ) ; 

f p rintf (pa ram_f i 1 e , " 7 . d Xf 11 , c oun t 

itemp = log_tach_b[ loop J ; 
ftemp = (float) itemp # 2.09263; 

ftemp “• (float )i 

fpr intf ( param_fi le , "Xf ", ftemp); 

itemp = log_torq_a[ loop ] ; 

ftemp = (float) itemp # 0.024414; 

fpr intf (par am_fi le , " Xf ", ftemp); 

i temp = 1 og_torq__b [ 1 oop ] ; 

ftemp = : ( f 1 oat ) i temp t 0 . 0244 1 4 ; 

f p r i n t f ( p a r am_ f i 1 e , " Xf \ n " , ft emo ) ; 

count +« i ; ' ‘ PAGE !S 

> OF QUALITY 


i nnn 


{ I ril-i rwr~1 \ «* 1 nnn«^+ *1 


ftemp ) ; 


SOLVER A REV 


aunt. , ftemp ) ; 



itemp — lag__ta.ch_aL loop] ; 
ftemp =( float ) itemp t 2,09263; 

f pr intf ( param_t i 1 e , "%d 7.f 11 . count, 

itemp = 1 og_tach_b [ 1 oop 3 ; 

ftemp = ( f .1. oat ) i temp # 2 . 09263 ; 

f pr intf ( par am_f i le ? " “if " , ftemp ) p 

itemp = 1 og__torq_a t I oop 3 p 

ftemp = (float) itemp t 0-024414; 

f pr intf ( param_f i le , " 7.f ", ftemp); 

itemp ~-log_torq_b[ loop 3 5 

ftemp = (float) itemp & 0-024414; 

fpr intf (param_f i le , ”%f \n" , ftemp); 

count += 1 ; 

J* 

count = 0 ; 

fpr intf ( para.m_.fi le , 11 RESOLVER A RE 

RESOLVER B RESOLVER B REV\n " ) p 

for (loop = (LQG__CNT - 1); loop < MAX_L06p loop++) 

ustemp = log_res_cnt_a[ loop ] ; 
ftemp = ( float ) ustemp t 0. 005493 j 

fpr intf ( param_.fi le , "7.d 7.f ", c 

itemp =•• log_res_rev_a[ loop ] 5 

fpr intf (param_.fi le , "7„d ", itemp) ; 

ustemp = log_res_cnt_b [ 1 oop ] ; 
f t e m p = (f loat ) ustemp # 0 , 0 0 5 4 9 3 ; 

fpr intf (param_fi le, " 7.d " , ftemp ) ; 

i temp = 1 og_res_rev_b [ 1 oop ] ; 

f p r i n t f ( p a r am_f i 1 e , " 7.d \ n " , c oun t , i t emp ) 5 
count += 1 ; 

S 

for (loop ~ 0; loop < (L0G_.CNT - 1); loop++) 

.r 

ustemp = log_res_cnt_.a[ loop ] ; 
f t e m p = ( f 1 o a. t )us t emp I 0 . 0 0 5 4 9 3 ; 

fpr intf (param_.fi le , "%d %f ",ca 

itemp = log_rss_rev_a[ loop 3 ;; 

for intf ( param_.fi le , " %d " , itemp ) ; 

ustemp = 1 og__res__cnt__b [ loop ] ; 

ftemp — ( float ) ustemp t 0., 005493 5 

fpr intf ( param_.fi le , "7.d ", ftemp); 

itemp = 1 o g_ r e s__ r e v_ b C 1 o o p 3 5 

f p r intf ( param_f i 1 e , " %d \n " , i temp ) s 

count +-• 1 ; 

\ 

J 

count - 0 ; 

fpr intf ( param_.fi le , " MOTOR COMMAND A MOTOR 

P I TON POS I T I ON P I TCH VELOC ITY\n " ) ; 

for (loop = (L0G_CNT -- 1); loop < MAX_L0G ; loop++) 

itemp = 1 og_motor_cmd_a[ 1 oop J--2048 5 
ftemp = (float ) itemp % 0.004883; 

fpr intf ( param_.fi le , ”7.d 7.f ", coun 

itemp = 1 og_motor_cmd_b [ 1 oop 3 --2048 ; 

ftemp = (float ) itemp t 0.004883; 

fpr intf (param_.fi le, " %f ".ftemp); 

ustemp = log_p i tch_pos[ loop 3 5 

ftemp -- ( float ) ustemp % 0.005493; 

fpr intf ( param_fi le , "7.f ", ftemp); 

itemp = log_p i tch_vel [ loop 3 ; 

-Pr\ r i r\t*4~ f n a r .=) m 4- i 1 .. 55 *ZH \ i~i n if* pmn v r ?• 


1)5 J-OOD++) 


count += i 5 


-Ftemp ) ; 


•for (loop — 0; loop < (L0G_CNT - 

itemp = log__motar_cmd_a[ loop] ; 
ftemp - ( float)! temp t 0. 004883?, 

f pr int f ( param_f i le , "Xd Xf " , count, 

itemp =loq_motor_cmd_b [ loop ] 5 

ftemp = ( f 1 oat ) i temp t 0 . 004883 ; 

fpr intf (param_f i le, "Xf ", ftemp); 

ustemp - 1 og_p i tch_pos[ 1 oop ] ; 

ftemp = ( float ) ustemp t 0,005493; 

fpr intf ( param_f i le , “Xf ", ftemp); 

itemp = log_p itch_vel [ loop ] ; 

f p r i n t f ( param_f lie, " Xd \n " , itemp ) ; 

count += 1 ; 


ITY 


temp ) ; 


count = 0 ; 

fpr intf (param_fi le, " YAW POSITION 

DES I RE P I TCH DES I RE YAW\ n " ) ; 

for (loop = (L0G_CN!T - 1); loop < MAX_L0G; 

ustemp = 1 og_yaw_pos [ 3. oop ] ; 
f t e m p = ( f 1 oat ) u. s t e m p t 0 , 0 0 5 4 9 3 ; 
fpr intf (par am_fi le , "Xd Xf 


YAW VEL0C 
1 oop++ ) 


, countjf 


itemp - ioq__yaw_vel [ loop ] ; 

fprintf(pa r a m_ f i 1 e " X d " , i t e m p ) p 

itemp = 1 og_d esir e__p i t c h_p os [ 3. oop 3 ; 

ftemp = (float) itemp t 0.005493; 

fpr intf (param_fi le, " Xf " , ftemp); 

itemp ~ 1 a g d e s i r e__ y a w__ posfloop ] ; 

ftemp = (float) itemp * 0,005493; 

fpr intf ( par am_fi 1 e , " Xf \ri", ftemp); 

count +~ 1 ; 


for (loop =::: 0 ; loop < (L0G__CNT - 1); loop ■+••+■) 


ustemp = 1 og_yaw_pos [ loop ] ; 
ftemp = ( float ) ustemp S 0.005493; 

f p r i ntf ( par am_f i 1 e , " Xd Xf " , count. ,, ft 

i temp = 1 og_yaw_ve 1 [ 1 oop 3 ; 

fpr intf (param_fi le, "Xd itemp); 

itemp = log__desi re__p i tch_ pos[ loop ] ; 
ftemp = (float) itemp t 0.005493; 
f p r i ntf ( par am_f i 1 e , " Xf " , ftemp ) ; 

i. t emp = 1 og_des i r e_y aw_p os [ 1 oop 3 ; 
ftemp = (float) itemp % 0,005493; 
fpr intf ( param_f i le H "Xf \n", ftemp); 
count +=1 ; 


/ 1 1 . e s t r o u t i n e s % / 
/ t count = 0 ; 


fpr i ntf ( param__f i 1 e , " l Q'RQLJE A\n " ) ; 

for (loop = (L0G_CNT - 1); loop < MAX_L0G; loop++) 


itemp = log__torq__a[ loop ] 
fp r i ntf ( param_f i 1 e , " Xd 
count += 1 ; 


Xd\n " , count , itemp ) ;; 


\ 


for (loop = 0; loop < ( L0G_CNT •- 1); loop++) 


itemp = 1 og__torq_aC loop ] ; 


count += 1 ; 
count -■ 0; 

-Fp r i ntf ( param_f i i e , "TORQUE B\n" ); 

■for (loop = (L 0 G_CNT -i)? loop < MAX_L 0 G 


i t emp - 1 og_t or q_b [ 1 oop ] 5 
fpr intf ( param_f i le , "Xd 


count += 1 ; 
■> 


*/.d\n" , 


1 GDp-H- ) 

count , i temp ) ; 


for (loop = Op loop < (L 0 G__CNT - 1 ); loop++) 

\ 

itemp = log_torq_b[ loop ] s 

fprintf (param_f i le, " Xd Xd\n" , count , itemp ) p 

count += 1 p 

1 torque test routines %/ 


f c 1 ose ( p a r am_f i 1 e ) p 
textcolo r ( BLACK ) p 
textbac kg round (WHITE) 5 
goto Ky ( 50 , 24 ) p 
cputs ( " 

textcolor (WHITE) p 
textbac k g r ound(BL.AC K ) ; 


t routine to get setpoint data off of disk 
# This data includes the joint operating limits 
% t % 1 1 % % % % % t % % 1 1 % t t t % % % tt/ 


void Load_Par ameters ( void ) 
\ 

FILE 
float 
i n t 

unsigned short 


f temp 5 


u st emp p 


#param_f i le , #f open ( ) 


itemp p 


param_file = f open ( "NASA . PAR" , "r")p 
i f ( p a r a m_ f i 1 e = = N U L L ) 

t e x tcolor { BLACK ) 5 
t e x t b a c k g r o u n d (WHITE) p 
g o t o x y ( 50 , 25 ) ; 
cputs ( " FILE ERROR " ) 5 


f sc an f ( p a r am_f i 1 e , " Xu " , Oust emp ) p 

MPTR— >sp p i t ch_h i__ 1 imi t = us temp p 


fscanf ( param_f i le , “Xu", feustemp ) 5 


MPTR~>sp . p i tch_h i_alarm = ustemp p 
fscanf (param_fi le, "Xu" , ?<u.stemp ) p 


MPTR— >sp . p i tch_neut ral — ustemp ; 


fscanf (param_fi le, "Xu" 
MPTR— >sp u p i tch_ 1 o_a 1 axrm 
f sc anf ( p ar am_f i 1 e , " Xu " 
MPTR— >sp .pit ch_ 1 o_ 1 i m i t 
fscanf ( par am_f i 1 e , "Xu " 


&ustemp ) s 
= ustemp p 
S'Ustemp ) 5 
- ustemp; 

Sc us temp ) p 


M P T R — > s p . d e .1 1 a__ p i t c h = : u s t e rn p p 
fscanf ( par am_f i 1 e , " Xu " , K.ust emp ) p 

MPTR— >sp yaw_h i_l imit = ustemp p 

-P c: »-■ xi r% -P i b- rx, m -P 1 7 1 1 V 1 1 1 * $*1 t cr. 4 - o m rn \ « 



e*/ 


M F : ' T R - > 3 p y a w_ h.i__alarm = us t e m p ; 
fscanf (param_-f i le, "Xu", 8<u.stemp ) ; 

MPTR— >sp ■ yaw_neutral = ustemp ; 
fscanf (param_fi le , "Xu", Scustemp); 

MPTR— >sp .yaw_lo__aiarm = ustemp; 
fscanf (param_file, "Xu.", ^ustemp ) ; 

MPTR— >sp , yaw_ 1 o_ limit = ustemp ; 
fscanf (param_fi le, "Xu", 8<ustemp ) ; 

MPTR— >sp . del ta_yaw = ustemp; 
f scanf ( param_f i le , "Xf " , &f temp ) ; 

MPTR— >gn .. A_pos_mot i on_sca 1 e — fternp ; 
fscanf (param_f i le, "Xf", S<ftemp); 

MPTR— >gn - B_pos_mot i on_sca 1 e - -fternp ; 
f scanf ( par am_f i le , "XT", ¥<f temp ) ; 

MPTR— >gn » A_ve l__mot i on_sca le = -fternp ; 
fscanf ( param_fi le , "Xf", ?<ftemp); 

MPTR->gn . B_vel_mot ion_scale = fternp; 
fscanf (param_fi le, "Xf", 8<ftemp); 

MPTR->gn A__motor_ve 1 -• fternp; 
fscanf (par am_.f i 1 e , " Xf " , 8< ft emp ) ; 

M P T R - > q n „ B__ m o t or_vel = f t e m p ; 
fscanf ( param_f i le, "Xf", Skf temp ) ; 

M P T R - > gn.A_ torque - f t emp; 
fscanf ( param_fi le , "Xf", SrFtemp); 

MPT R -- > g n „ B__ t orque = f t e m p ; 
f scanf ( param_fi 1 e , "Xf " , “'.fternp); 

M P T R — > g n . A ... p o s i t i o n = f t e m p ; 
fscanf ( param_.fi le , "Xf " , 8 <ft.emp ) 5 
M P T R - > g n . B_ p o s i t i o n = f t emp; 
fscanf ( param_fi le , "Xf", 8 <f temp ) ; 

MPTR— >gn A__ou.tput_.vel fternp; 
fscanf ( param_.fi le?, "Xf " , 8 <ftemp ) 5 
MPTR->gn . B_output_vel = fternp ; 
f s c a n -f : ( p a r a m_. file, " X ci " , ?< i t e m p ) 5 
MPTR— >gn . d i rect ion = itemp; 
f sc an f ( p a r am__f i 1 e , " Xf " , 8 <f t emp ) 5 

MPTR-> jy . x_gain = fternp; 
fscanf ( param_f i le , "Xf " , ?<f temp ) ; 

M P T R -• > j y y__ g a i n = f t e m p 5 
f c 1 ose ( p a r am_f i 1 e ) ; 

PARAMETER__FLAG = FALSE; ' /*set to false, set true if val 

} /Jtchangel/ 


/♦routine to save setpoint data and parameters 

will check to see if data has been changed, if no 
the routine will not do anything#/ 

void Save_Parameters ( void ) 

r 

FILE 

float fternp; 

int itemp; 

unsigned short ustemp; 
char 


$param_f i 1 e , #f open ( ) ; 


answer ; 



i f 


(PARAMETER... FLAG == TRUE) 

r 

L 

textcolo r ( BLACK ) ; 
t extbac kg round ( WH I TE ) ; 
got oxy ( 20 ,15); 

cputs( "SYSTEM PARAMETERS HAVE BEEN CHANGED 
g o t o y ( 2 0 , 1 6 ) ; 

cpu.ts ( "DO YOU WISH TO SAVE NEW PARAMETERS Y/N 


" ) 5 

" ) s 


answer = fgetcharf); 
textcolo r ( WH I TE ) j 
textbackground ( BLACK ) ; 
goto xy ( 20 , 15 ) 5 
c 1 reel ( ) 5 
goto y ( 20 ,16) = 
c 1 real ( ) 5 
gotoxy ( 50 , 1 1 ) 5 

if ( (answer == ) II (answer == n y ’ ) ) 

param_f i le = -f open ( “NASA » PAR" . “w" ) 
i-f (par am_f i 1 e -- NULL ) 

text col or (BLACK ) 5 
text-background (WHITE) j 
gotoxy ( 50 , 25 ) 5 
c P ut s ("FI LE ERROR “ ) 3 
sound ( 500 ) ? 
delay ( 1500 ) 5 
nosound ( ) 5 
delay (7500) ; 
y 

ustemp - MPTR->sp » p i tch_h i 1 i m i 1 5 

fpr i nt-f ( par am_f i le , "%u\n" , ustemp ) 
ustemp = MPTR— >sp . pi tch_h i_alarm; 
■fpr intf (param_.fi Is , "%u\n " ustemp ) 
ustemp = MPTR->sp p i tch_neutral 5 
•f p r i nt-f ( param_f ile, " %u\n " , ustemp ) 
ustemp = MPTR->sp . p i tch_ lo_al arm 3 
f p r i n t f (para m__ file , 1 ' 7, u \ n " , u stamp) 
ustemp = MPTR->sp .pitch_lo_l imit ; 
f p r i n t f ( p a r a m_ f i 1 e , 1 ’ 7. u \ n ! 1 u s t e m p ) 
u s t e m p - ii P T R - > s p . d e 1 1 a_ p i t c h 5 
fprintf (param_.fi le, "%u\n" , ustemp) 
ustemp - MPTR->sp „ yaw_h i_ I i m i 1 5 
fpr intf ( param_.fi le , "5iu\n" , ustemp) 
u. s t e m p - M P T R - > s p . y a w__ h i a 1 arm ; 
f p r i n t f ( p a r a m_ -f i .1 e, " % u\n " , ustem p ) 
ustemp = MPTR->sp .yaw_neutral 5 
fprint.fi p a r a m_ file, " Xu\n “ ,, u s t e < n p ) 
ustemp = MF'TR— >sp . yaw_l o_al arm ; 

•fpr intf ( param_.fi le , "7„u\n" , ustemp ) 

ustemp = MPTR— >sp . yaw_lo_l imit ; 
f p r i n t f ( p a r am._f ile, " Y»u\. n " ,, ustemp ) 
ustemp - MPTR— >sp ■ del ta_yaw ; 
f p r i n t f ( p a 1 - a m_. file, 1 ' % u \ n " , u s t e m p ) 
ftemp - MPTR— >gn » A_pos_mot ion_scale 
f p r i n t f ( p a r a m__ file, 1 1 % f \ n 1 ' , f t e rn p ) 5 
ftemp = MF'TR->gn . E<_pos_mot ion_scale 
fpr intf ( param_f i le , "%f \n " , ftemp ) 5 
ftemp = MPTR— >gn „ft_veI_motian_scale 
fprintf (param_.fi le, "%f\n", ftemp)? 
ftemp = MPTR— >gn , B_vel_mot ion_scale 
fpr intf ( param_.fi le , "7.f\n“ , ftemp); 

ftemp = MPTR->gn » A_motor__vel 5 
fpr intf (param_fi le, "%f\n", ftemp) ; 
ftemp = MPTR— >gn . B_motor_vel ; 
fpr intf ( param_.fi le , "/if\n", ftemp); 

ftemp MPTR- > q n „ A_ t o r q ue % 

f p r intf ( par am__f i 1 e , " ”/.f ' \n “ , f temp ) 5 

f t e m p M P T R - > g n . E<__ t o r qu.e : 

fprintf (param_.fi le, “ %f \n “ , ftemp) ; 
•f : t e m p - M P T R - > g n , A__ p o s i t i a n s 
fpr intf (param_fi le , "7,f\n“, ftemp) 3 

ftemp MPTR— >gn , B_posi t i on r, 


ftemp = MPTR->gn . A_output_vel 5 
f pr intf ( param_f i le , "Xf\n'' , ftemp) 

ftemp = MPTR— >gn . B_ou.tput_vel 5 
f p r intf ( param_f i le , "%f\n" , ftemp) 
i temp = MPTR->gn . d i rect i on 5 
fpr intf ( param_f i le , "%d\n", itemp) 



ft emp = MPTR— > j y . x_ g a i n 5 

fpr intf ( param_fi 1 e , "%f\n" 5 ftemp) 

ftemp — MPTR— > jy .y_gain ; 

fpr intf ( param_f i le , "%f\n ! * ,, ftemp ) 

f c 1 ose ( p a r am_f i 1 e ) 5 




/ ft ft ft ft ft ft ft ft ft & ft $ 4 ft ft $ ft ft ft ft ft ft ft ft ft 
ft FILES NASA4.C 

* DATE.: July 28, 1990 

ft 

ft ROUTINES 

ft B r a k e_ L a c k 

ft Bra k e_ U n 1 a c k 

ft D i s p ]. a y__.. S y s t e m_ D a t. a 

ft Mod_Set point 

ft Mod__Gain 

ft R an g e_Ch ec k 

ft D i s p 1 a y_ S y s t e m_ S e t. p o i n t s 

ft D i s p 1 a y _ S y s t. e m_ Gain s 

ft 

ft 

ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft / 


# i n c 1 u d e " e t. d a t a h ' ' 
ttinclude "nasadef „ h" 

# i n c 1 u d e < d o s . h > 

# include < conio.h > 

# i n c I u d e < s t d i o » h > 


/ ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft 
ft lock the motor brakes 
ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft / 


v o j. d Bra k e._ L a c k ( v a i d ) 


o u t p o r t b ( 1 0_ 0 U T , L 0 C !<_ B ) 5 

M P T R — > 1 T 1 a . m o t __ d r i v e -- 2 0 4 8 

MPTR->mb . mot__dr ive — 2048 

Motor_.Dr i ve { ) : 

t e x t c: o 1 o r ( BLACK ) ; 

t e t b a c k g r o u n d ( W H I T E ) $ 

gotoxy ( 60 , 24 ) ; 

cput:s(" " ) r, 

gotoxy ( 60 , 24 ) 5 

cputs ( " LOCK •'); 

t e x tool o r ( W H I T E ) ; 

t e x t b a c k g r o u n d { B L A C K ) : 

sound ( 800 ) 5 

d e 1 a y ( 5 0 ) s 

nosound ( ) ; 


ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft 
ft unlock the motor brakes 
ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft. ft ft ft / 

v o i d B r a k e__ U n 1 a c k ( v o i d ) 

\ 

M P T R — > m a « rn o t d r i v e = 


2048 


Motor __Dr i ve ( ) ; 

out p o r t b ( 1 0__QUT , UNLOCK_ 

textcolor ( E<LACK ) 5 

t e x t b ac k g r oun d ( WH I TE ) 5 

g o t o y ( 6 0 ,24) 5 

cputs ( " " ) i 

gotoxy ( 60 , 24 ) 5 

cputs ( " UNLOCK " ); 

textcolor ( WH I TE ) 5 

t e x t b a c k q r o u n d ( B L A C K ) 5 

sound ( 400 ) ; 

del ay ( 50 ) ; 

nosound ( ) 5 


B) : 


/ 1 % 1 1 1 1 % % t $ $ % % % % % t % % % % %% % 

% routine to show system data, can unlock brakes and 
% move joint, and watch data changes 
% $ % % 1 1 % * t * # 1 1 * 1 1 * t * % 1 1 % t / 


v oid D i s p 1 a y__ S v s t e m_ D a t a ( v o i d ) 

i n t: d a n e__ -f 1 a g 5 

char c ; 


done_-flag - FALSE 5 

t extcolor ( W H I T E ) ; 

t e x t b a c k g r o u n d ( B L A C K ) 5 

c 1 rscr ( ) ; 

textcolor (BLACK) 5 

t e x t b a c k ground(WHITE) ? 


goto 

xy ( 1 

, 1)5 


cput 

s ( 11 

MOTOR A 

DAT A 

goto 

xy ( 1 

, 2 ) 5 


cput 

s{" 

Tac hornet 

er 

goto 

x y ( 1 

, 3 ) 5 


cput 

s( 11 

T orque 


goto 

x y ( 1 

5 4 ) 5 


cput. 

s( " 

Peso 1 ver 

Count 

goto 

xy ( .1. 

, 5 ) 5 


cput 

s ( 1! 

Peso 1 ve r 

Revs 

goto 

x v ( 1 

, 6 ) , 


cput 

s ( " 

Resolver 

Ve 1 

goto 

x y ( 1 

? • $ ? 


cput 

s ( " 

Resolver 

Ang .1 e 

goto 

xyd 

» 10) 5 


cput 

s ( " 

MOTOR B 

DATA 

goto 

xy(l 

•i 1 1 ) 5 


cput 

s( “ 

Tac hornet 

er 

goto 

xy ( 1 

ID'., 

, J. •*- ) 4 


cput 

CTj. / 11 

Torque 


goto 

xy ( 1 

? 13 ) 5 


cput. 

s ( " 

Peso 1 ver 

Count 


) ? 
" \ » 

n ) 5 
n ) ? 
n ) 5 
11 ) 5 

" ) 5 

" ) s 


gotoxy ( 1 , 1 4 ) 5 

cputs (" Resolver Revs "); 

gotoxy ( 1 , 1 5 ) ; 

cputs ( ,! Resolver Vel “ ) ? 

gotoxy (1,1 6 ) ; 

c put s ( " R e s a lver A n g 1 e 11 ' ) ; 
gotoxy ( 1 1 8 ) 5 
cputs ( " PITCH / YAW DATA 
gotoxy ( 1 , 19 ) 5 

c p u t s ( 1 1 P i t c h R e s o 1 v e r C o u n t 

gotoxy ( 1 , 20 ) 5 


" ) j 
11 ) ; 




gotoxy ( 1 , 2 1 . } 3 
c p ut s ( " Pitch An g 1 e 
gotoxy ( 1 , 22 ) 5 

cputsi " Yaw Resolver Count 
gotoxy ( i , 23 ) 3 
cputs (" Yaw Resolver Vel 
gotoxy ( 1 , 24 ) 3 


cputs < 


:'aw Anale 


t ex t c o 3. a r ( BLACK ) 3 
textbackground (WHITE) 5 
gotoxy ( 1 , 25 ) 5 
cputs ("ENTER ’E’ Tu EXIT 
tax tool or (WHITE) 5 
t e x t b ac k g r oun ci ( BLACK ) 3 
wh i 1 e ( J don e_f I ag ) 


> 5 


'Ll’ TO UNLOCK & ? L : 


TO LOCK BRAKES" ) 3 


Get_Joint__Data ( ) 3 




gotoxy ( 

18,2) 

n 




c 1 real ( 

) 3 





gotoxy ( 

18,2) 

•5 




p r i n t -F ( 

"lid" H 

MPTR- 

->ma . 

tach ) 

3 

gotoxy ( 

18,3) 

;i 




cl real ( 

) 3 





gotoxy ( 

1 8 3 ) 

5 




p r i n t -F ( 

" %d " , 

MPTR- 

~>ma . 

torq ) 

3 

gotoxy ( 

1 8 , 4 ) 





c 1 real ( 

) 5 





gotoxy ( 

18,4) 

n 




p r i n t -f ( 

"y.u 

y v ,{ 

/u t’\ 

MPTR 

>ma . 

res_cnt 

g 0 1 0 )•; y ( 

1 8 , 5 ) 





c 1 re 0 1 ( 

} q 





gotoxy ( 

1 8,5) 





p 1 1 - i n t F ( 

"Ad" , 

MPTR- 

->ma » 

res_r 

ev ) 3 

gotoxy ( 

1 B , 6 ) 





c 1 real ( 

) 3 





gotoxy ( 

18,8 ) 

«{ 




p r i n t -f ( 

"lid " , 

MPTR- 

■- ffi a « 

res... vel ) 3 

gotoxy ( 18 5 7 ) 





c 1 reo 1 ( ) 3 





gotoxy ( 18 , 7 ) 

3 




p r i n t f ( 

" % „ 2 f 

” , MPTR— >ma , res 

_ang ) $ 

gotoxy (18,11 

> .3 




c 1 reo 3. ( 

) 5 





gotoxy ( 

18,11 

) 3 




p r .i n t f ( 

“ Zd " , 

MPTR- 

->mb . 

tach ) 

n 

gotoxy ( 

1 8 , 1 2 

) 3 




c 1 reo 1 ( 

) 3 





g 0 1 0 x y ( 

18,12 

) 3 




p r i n t -f ( 

" "id " , 

MPTR- 

~>mb . 

torq ) 

n 

gotoxy ( 

18,1 3 

) 3 




c 1 reo 1 ( 

) 3 





gotoxy ( 

1 8 , 1 3 

) 3 




pr intf ( 

"%u 

V v >• 

/tf/i q 

MPTR 

—>rnb . 

r 0 s c n t 

g a t a x y ( 

IS, 14 

) 3 




c 1 reo 1 ( 

) 3 





gotoxy ( 

18, 14 

> 3 




pr intf ( 

"lid" , 

MPTR- 

->mb . 

res_r 

ev ) ; 

gotoxy (18,15 

) 3 




c 1 reo 1 ( 

) 3 





gotoxy ( 

18, 15 

} 3 




pr intf ( 

" /id " , 

MPTR- 

->mb . 

res vel ) s 

gotoxy { 

18,1 6 

) ,1 




c: 3. reo 1 ( 

) 3 





gotoxy ( 

18,16 

) 3 




p r i n t. f ( 

" Y. „ 2f 

1 ' ,, M P T K > mb. r e s 

_ang ) 3 



MPTR->ma » res_cnt ) 5 


M P 1 R - > m b « r e s__ cnt ) ; 


c 1 reel ( 

) 5 



gotoxy ( 

24 

19 

) p 

pr int-f ( 

11 y ; 

LI 

Xx 

gotoxy ( 

24 

,, 20 

) q 

c 1 reo 1 ( 

) p 



gotoxy ( 

r. 

, 20 

) ; 

p r i n t f ( 

»*“/, 

.'u 

d" , 

MR' 

gotoxy ( 

24 

,21 

) p 

clreol ( 

) 5 



gotoxy ( 

24 

,21 

) P 

p r i n t f ( 


.2f 

", 1 

gotoxy ( 

24 


> ? 

c 1 reel ( 

) ? 



gotoxy ( 

24 


) ? 

p r i n t -f ( 

"X 

u 

Xx 

gotoxy ( 

24 

*-\ “T 

1 - 

c 1 reo 1 ( 

) ? 



gotoxy ( 

24 

a AS 

) S 

p r i n t f ( 

11 °/ 

d" , 

MR 

gotoxy ( 

ti 

, 24 

) ? 

c 1 reo 1 ( 

) 5 



gotoxy ( 

24 

„ 24 

\ » 

} ;i 

p r int-f ( 

"X 

’ 2-f 

H 1 
3 1 

delay ( 1 

00 

) p 


:i. f ( k b hi 

it 

( ) 

) 


‘1 

r 

= 

get 


i f ( 

(c 


0 

.1 se 

if 


0 

lse 

if 


’ E ’ ) 


! \ (c ’s’)) done_flag = TRUE 5 
’Ll’ ) ! 1 (c : =~ : ’li’ ) ) Br ake_JJn I ock ( ) 5 
! ! (c =* ’ 1 ’)) Brake_Lock( ) 5 


c 1 rscr ( ) 


/ $ $ # 1 1 % % % t %%%% % -k % % % % % * t % 

Y routine to change a setpoint during system operation 
& * >jc t # % $ t t '(< % t # t # # # >!< * * * t / 


vo i d Mod_ __Setpoi nt ( i nt max__y ) 


int 
i n t 

unsigned int 
se 1 ect 

y 


va 1 u.e ; 

— 0x00 i 


select q 
y 5 


t: e x t c a 1 a r ( W H I T E ) p 
t e t b ac k g r ou.n d ( BLACK ) q 
gotoxyf 1 , 25 ) 5 
c 1 re o 1 ( ) ; 
t e x t c o .1 a r ( BL. A C !< ) q 
textbackground (WHITE) q 
gotoxy ( 1 , 25 ) q 

c:puts( "KEYPAD NUM LOCK ON USE UP/DOWN KEYS ENTER TO SELECT" ) 5 

t e x t color ( W i-i I T E ) q 

t e x t bac k g r o u. n d ( B L A C K ) q 

gotoxy ( 1 , y ) p 

cputs ( " t " j 5 

wh i 1 e ( se I ect ! = 1 3 > 


de 1 ay ( 100 ) t 
select = getch ( ) q 


case 50 


case 56 


de-fau 1 1 

\ 


y = y + i g 

t e x t c o 1 o r ( B L A C K ) 5 
textbackground (WHITE) 3 
got a ;:y ( 3 . , y— 1 } 5 
cputs ( " " ) ; 

if (y > max_y) y = 2; 
text co lor (WHITE) 5 
t e x t b a c k groun d ( B L A C K ) 5 
qotoxy ( 1 ,y ) ; 
cputs ( "SC" ) 5 
b reak 5 
y = y — 1 3 

textco 1 or ( BLACK ) ; 

textbackground (WHITE) 3 

qotoxy ( 1 , y+1 ) 3 

cputs (" " ); 

if (y < 2) y max_y? 

textcolor (WHITE) ; 

t e x t b a c k g r o u. n d ( B L A C K ) 5 

gotoxy ( 1 , y ) ; 

cputs ( " # " ) 5 

b reak 3 

break 3 


t e x tool o r ( WH I TE ) 3 

t e x t b a c k g r o u n d ( B L A C K ) 3 

gotoxy ( 1 j, 25 ) 3 

c I real ( ) 3 

textco l or ( BLACK ) 5 

t e x t b a c k g r o u n d ( W H IT E ) g 

gotoxy ( 1 , 24 ) 3 

cputs ( "ENTER' IN MEW SETPOINT VALUE " 

textcolor (WHITE) ? 

textbackground ( B L A C K ) g 

q ot o x y ( 30 , 24 ) g 

s c a n -f ( “ % u ' ' ,, S-; v a 1 u e ) 3 

gotoxy ( i ,,24 ) g 

clreolf); 

textcolo r ( B L A C K ) g 

t e x t. b a c k g r o u n d ( W H I TE ) 3 

gotoxy ( 1 , y ) 3 

cputs ( " " ) 3 

PARAMETER ...FLAG = TRUE 3 
switch (y) 


case 

2 

s 

MP TE- 

>sp ,pitch_hi_.I irnit = 

va 1 ue 5 

break 3 

c a s e 

"T 

s 

MP TE- 

> sp „ p i t c h__ h i __ alarm = 

value 5 

b reak 3 

c a s e 

4 

s 

MP TR— 

>sp . p i tch_neut r a 1 - 

val Lie 3 

break ; 

case 

5 

s 

MPTR— 

> s p , p 1 1 c h_ I o_ ala r m ~ 

va 1 Lie 3 

break 3 

case 

6 

s 

MPTR- 

> s p „ p i t c. h_ 1 0 limit = 

va 1 ue 3 

break 3 

case 

7 

s 

MPTR- 

> s p „ d e 1 1 a_ pitch = 

va 1 ue g 

break 3 

case 

8 

s 

MF'TR— 

> s p „ y a w__ h i _ 1 i rn i t r ~ 

va 1 ue 3 

b reak ; 

case 

9 

s 

MPTR- 

> s p « y a w_ h i _ a 1 a r m = 

va 1 u.e g 

b reak 3 

case 

10 

» 

MPTR- 

> s p . y a w__ n e u t r a 1 = 

va 1 ue 3 

break 3 

c a s e 

1 1 

S 

MPTR— 

> s p „ y a w_ 1 o . _ a .1 a r m ~ 

va 1 ue 5 

break 5 

case 

■< 

“ 

MPTR— 

> sp « yaw _ 1 o__ limit = 

va 1 ue 3 

b reak 5 

case 

13 

a 

MPTR— 

> sp.del t a_ y a w = 

va 1 ue 3 

b reak 5 

de-faul t 

s 

break 

3 





t ext c o I o r ( B L. A C K ) 3 
t e x t b a c k g r o u n d ( W H I T E ) 3 
gotoxy ( 1 , 25)5 

cputs ( "ENTER' ! E J TO EXIT 3 C j TO CHANGE A SETPOINT " ) ; 


Sr.* x a u r v Wit * it. / i; 

t e k t b a c k gro u n d ( L A C i< ) ; 



t $$#$$$#$$$$$$]{($#$# t t&tt 
t routine to change a gain 
% % % % t % % % % % % t & t $ & $ % t & t # # t / 


dur i ng system operat i on 


vo i d Mod_Ga i n ( i n t ma x__y ) 


int select.; 

i n t y 3 

-Float values 


se 1 ect = 0 x 00 3 

y “ 2 ; 

t e x t. c o 1 o r (WHITE) 5 

textbac kground (BLACK) 3 

gotoxy ( 1 , 25 ) ; 

c 1 reo 1 ( ) 5 

text co lor (BLACK) 5 

t e x t b a c kground ( W HITE) ; 

gotoxy ( 1 s 25 ) ; 

cputs( "KEYPAD MUM LOCK ON USE UP/DOWN KEYS ENTER TO SELECT" ) 5 

t. e x t c o 1 o r ( W HITE) ; 

t. e x t b a c k g r o u n d ( B L A C K ) 5 

gotoxy ( 1 , y ) 5 

cputs( ) 5 

wh i 1 e ( se .1 ec t ! - 13 ) 


delay ( 100 ) ; 
select = getch ( ) 
s w i t c: h ( s e 1 e c t ) 

r 

c 

case 50 


case 56 


de-fault 


t e x t color (BL A C K ) ; 
t e x t b a c k g r o und ( W H I T E ) 5 
gotoxy ( 1 y— 1 ) ; 
cputs ( " " ) ; 
if (y > ma;:_y ) y = 2; 
text co lor (WHITE) 5 
t e x t. b a c k g r a u n d ( B L A C !< ) 3 
gotoxy ( 1 , y ) ; 
cputs ( “ t " ) r, 
break 3 
y -- 1 % 

textco 1 or ( BLACK ) ; 

t e x t b a c k q r o u n d (WHIT E ) 1; 

gotoxy ( 1 , y+1 ) ; 

cputs ( " "); 

if (y < 2) y ~ max_y; 

textco 1 or { WHITE ) ; 

t e x t b a c k g r o u n d ( B L A C K ) 5 

gotoxy ( i 5 y ) 3 

cputs ( " t " ) 3 

break 3 


t e x t. c o 1 a r ( WH I TE ) 5 
t e x t b a c k g r o u. n d ( B L A C K ) 5 
gotoxy ( 1 , 25 ) 3 
c 1 real ( ) s 
t e x t col o r ( B L A C K ) 3 


/* 


%/ 


l. td *_ u au s ; . y r uu: s u \ wn x ; ; * 

gotoxy ( 1 ? 24 ) 5 

cputs( “ENTER IN MEW GAIN VALUE " 

textcolor (WHITE ) 5 

textbackground ( BLACK ) ; 

goto x y ( 30 5 24 > ; 

scan f ( " %f i! , &va i ue ) p 

gotoxy ( 1 ? 24 ) p 

c 3. reo I ( ) p 

textcolor ( BLACK ) p 

textbackground ( WHITE ) p 

gotoxy ( 1 , y ) ; 

cputs ( " ”)?’ 

F'ARAMETER_FLAG = TRUE; 
switch (y) 


case 


s MPTR- 

>qn * A pos mot. ion scale 

= 

va 1 ue 5 

b reak 

c ass 

~r 

s MPTR- 

>qn.B pos motion scale 

~ 

value ; 

break 

case 

4 

s MPTR- 

>gn . A_ve l__mot i on_scal e 

= 

value ; 

break 

case 

cr 

5 MPTR- 

> q n « El v e 1 motion scale 

- 

va 1 ue ; 

b reak 

case 

6 

; MPTR- 

>gn « A_motor _vel 

=r. 

va 1 ue ; 

break 

c ase 

7 

; MPTR- 

> g n . B m 0 1 0 r v e 1 

•- 

va 1 ue 5 

break 

case 

8 

: MPTR- 

> g n „ A_ 1 0 r q u e 

- 

va 1 ue ; 

break 

case 

Q 

2 MPTR- 

> q n . B_ t a r q u e 

ss 

value; 

b r sa k 

case 

10 

s MPTR 

->gn , A__posit ion 

- 

value ; 

b reak 

case 

11 

2 MPTR 

- > g n „ E-i__ p os it ion 


va 1 ue ; 

b reak 

c ase 

12 

s MPTR- 

- > g n . A_ 0 u t p u t _ v e 1 

=s 

value ; 

b r ea k 

case 

13 

: MPTR 

•• > q n . B output v e 1 

— 

va 1 ue a 

break 

case 

14 

; MPTR 

->qn » d i rect i on 

= 

(int) val 

ue ; 

C cA Si -0 

15 

a MPTR 

--> jy . x_gain 

- 

va 1 ue ; 

b reak 

case 

i 6 

a MPTR 

-> jy y__ga i n 

- 

value ; 

b r ea k 

case 

17 

a MPTR 

- > g n „ 


value; 

b r ea 3 a 

case 

18 

a MPTR 

- > g n . 


va 1 ue ; 

b r ea. k 

case 

19 

s MPTR 

~>gn . 

~ 

value a 

b r e a k 


default s break; 

\ 

t e x t c o 1 o r ( B L. A C K ) p 
t e x t. a c k ground(WHITE) p 
gotoxy ( 1 H 25 ) p 

cputs ("ENTER' ’E’ TO EXIT ’C’ TO CHANGE A SETPOINT " 
t e x t c o 3. o r ( WH I TE ) p 
textbackground (BLACK) ; 


/ % tttktkktt %%%%%%* % % %%t% % 

t routine to check that alarms and limits are where they 
-$ should be 

>y. % % % % ift t % % t ijc % t % % % 1 1 1 %%% %%/ 


void R a n g e__ C h e c k ( v o i d ) 


char terror; 


er ror 


NUL 


OF POOR 


if ( MPTR— >sp „ p i tch_h i__ 1 i mi t < MPTR— >sp » p i tcf"i__h i__a larm ) 


e r r 0 r 

= "PITCH 

HIGH LIMIT 

OUT OF 

SPEC" ; 

else if ( ("I f— ' 1 R - 

->sp . p i tch 

_hi_alarm ■ 

> MPTR- 

->sp .pitch_neutral ) 

e r r a r 

= "PITCH 

HIGH ALARM 

OUT OF 

SPEC" ; 

else if (MPTR - 

->sp . p i to 3 _ ! 

__lo__.a3.arm ' 

-= MPTR- 

- > s p .pit c 3i__ n e u t r a 1 ) 


error = "PITCH LOW ALARM OUT OF SPEC" p 
e I s e i f ( M P T R — > s p . p i t c h__ 3 . o_ i i rn i t > id P T R — > s p „ p i t c h_ 3 . o_ a 1 a r m ) • 
error » "PITCH LOW LIMIT OUT OF SPEC" p 

i f ( M P T R -- > s p « y a w__ h i 1 i m i t < M P T R - > s p . y a w__ h i __ a larm ) 

e r r o r = ‘ 1 Y A W H I G 3-1 L I M I T 0 U T 0 F S P EC" ; 
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e 3. se 


!~ J. !~* 

p 1 50 
e 1 se 


it \ rir* I r , — 5 p «ya n i _ a i a r m — n r ! r*. — a p « y a n e u c r a. j. ; 
error -- “YAW HIGH ALARM OUT OF SPEC" ; 


if (MPTR- 

>sp . yaw 

lo 

alarm 

e r r o r 

= "YAW 

LOW 

ALARM 

if (MPTR- 

>sp . yaw 

lo 

limit 

e r r o r 

= "YAW 

LOW 

LIMIT 


>-- MPTR~>sp „ yaw_neutral ) 
OUT OF SPEC"; 

> MPTR— >sp » yaw_ i o_a 1 arm ) 
OUT OF SPEC" ; 


if (error != NULL) 


t e t c o 1 or ( BLACK ) ; 
textbackground (WHITE) ; 
gotoxy ( 1 5 25) ; 
cl reel ( ) ; 

pr intf ( "Y.s" , error); 

sound ( 500 ) ; 

del ay ( 500 ) ; 

nosound ( ) ; 

gotoxy ( 1 , 25 ) $ 

c 1 reo 1 ( ) ; 

gotoxy ( 1 , 25 ) ; 

eputs ( "ENTER* ’F-’ TO FINISH ’C’ TO CHANGE A SETPOINT 

text co lor (WHITE) ; 

tex t b ackgrou n d ( E< L A C K ) ; 


" ) s 


/%% $ 4 4 44 44 4 4 4 4 4 4 4 4 4 4 4 4 4 4 4 

4 routine to display system setpoints and allow changing 
4 the setpoints during system operation 
4 % 4 4 4 4 4 4 4 4 4 4 4 4 4 4 4 4 4 4 4 4 4 4 / 


void Disc lay__System_5etpoints( void ) 


i n t 

done__ 

c h a r 

c ; 

i n t 


i n t 

max_y 


1 3 s 


x = 26; 

d o n e__ f lag ~ FA L S E ; 

t e x t colo r ( W H I T E ) ; 

t e x t b an c k g r o u n d ( B L A CK ) ; 

c: 1 rscr ( ) ; 

t e x t c o 1 o r ( B L A C K ) ; 

t e x t b a c k q r o u n d ( W H I T E ) ; 

gotoxy ( 1 5 1 ) ; 

eputs ( " SYSTEM SETPOINTS " ) ; 

gotoxy (1,2 ) ; 

cputs(" Pitch Limit High "); 

gotoxy ( .1. , 3 ) ; 

cputs( " Pitch Alarm High "); 

gotoxy (1,4); 

cputs( " Pitch Neutral Position "); 
gotoxy ( 1 , 5 ) ; 

c p u t s ( 11 P itch A 1 a r m Low ' ' ) ; 

gotoxy ( . 1 . , 6 ) ; 

eputs ( 11 Pitch Limit Low ” ) ; 

gotoxy (1,7); 

eputs (" Pitch Delta "); 

gotoxy ( 1 , 8 ) ; 

eputs (" Yaw Limit High "); 

gotoxy ( 1 , 9 ) ; 

c p u t s ( 1 ' Y a w A 1 a r m H i g h " ) ; 

gotoxy (1,1 0 > ; 

c p u t s ( 1 ' Y a w N e u t r a 1 P o s i t i o n " ) ; 

gotoxy ( 1 , 1 1 ) ; 


cputsf raw Miarm low 

gotoxy (1,12)5 

cputs( " Yaw Limit Low 

gotoKy ( 1 , 13 ) 5 

cputs(" Yaw Delta 

gotaxy ( 1 , 25 ) 5 

cputs ( "ENTER E ? TO EXIT 

t e k tool o r ( WH I TE ) 5 

t e x t b s.c k g r oun d ( BLACK ) 5 

wh i 1 e (Id on e_F 1 ag ) 


) % 

" ) 5 
" ) 5 

T 1 TO CHANGE A SETPOINT " ) 5 


gotoxy ( x , 2 ) 5 
c 1 reel ( ) 5 
gotoxy ( x ,2) 5 
print-F ( " 7 .u" , MPTR- 
gotoxy ( x , 3 ) 5 
c 1 reo 1 ( ) 5 
gotoxy ( x , 3 ) 5 
print-F ( "Xu" , MPTR- 
gotoxy ( x , 4 ) 5 
c 1 reo 1 ( ) 5 
gotoxy ( x , 4 ) ; 
printf ( "Xu" \ MPTR- 
gotoxy (x ,5)5 
c 1 reol ( ) ; 
gotoxy ( x , 5 ) 5 
pr intFC "Xu" , MPTR- 
gotoxy ( x ,, 6 ) 5 
c 1 reol ( ) 5 
gotoxy ( x , 6 ) ; 
pr intF( "Xu." , MPTR- 
g o t a x y ( x , 7 ) p 
c 1 reol ( ) s 
gotoxy ( x , 7)5 
printf ( "Xu" , MPTR- 
g o t o x y 1, x , G ) 5 
c 1 reol ( ) ; 
gotoxy ( x , 8 ) 5 
printf ( "*/.u" , MPTR— 
gotoxy ( x , 9 ) s 
c I reo 1 ( ) 5 
gotoxy ( x , 9 ) 5 
pr intF( "Xu" , MPTR— 
gotoxy ( x , 10 ) 5 
c .1 reo 1 ( ) ; 
gotaxy ( x ,10)5 
pr intFC "Xu" , MPTR— 
gotoxy ( x 1 1 ) 5 
c 1 reo 1 ( ) 5 


sp „pitch_hi_l imit ) 5 


sp . p i tch__h i_a 1 a r m ) 5 


sp . p .i t c h__n eu t r a 1 ) 5 


s p . p i t c h_ 1 o__ alar m ) ; 


sp u p i t. c: h__ 1 o_ 1 i m i t ) 5 


sp = de 1 1 a_p i t ch ) 5 


sp . y aw_b i__ limit) 5 


sp „ yaw__h i _ _ a .1 arm ) 5 


sp . yaw_neu.tr a 1 ) 5 


gotoxy ( x , 11 ); 

printF("%u" , MPTR— >sp « yaw_l o_al ar m ) 5 
gotoxy ( x , 12 ) ; 
c 1 reol ( ) 5 
gotoxy ( x , 12 ) 5 

printFC "Xu" , MPTR— >sp.yaw_lo_l imit ) ; 
gotoxy ( x , 13 ) 5 
c I reol ( ) 5 


gotoxy (x, 13 ) 5 

p r i n t F ( " Xu " , MPTR— > sp » d e 1 1 a_yaw ) 5 
del ay ( 500 ) 5 
iF (kbhitC) ) 


c — getch ( ) 5 

iF ( (c == ’ E’ ) j ■ (c r 'e : ’ ) ) done_Flag 

else iF ( (c — — ’C’ ) ! i (c = — ? c. T ' ) ) 

r 

*L 


TRUE 


Mod_Set p o 1 n t ( ma x_y ) p 
Range_Check( ) p 


textco 1 or ( WHITE ) ; 
tsxtbackqround ( BLACK) p 
clrsc r ( ) 5 


/ $ # 3jT # # # )f( # # t * t * t 1 1 % % 1 1 1 # 3ft $ 

# routine to display system gains and allow changing 
t the gains during system operation 

* 1 1 >!< $ % %t $ % t % t * % t %%%%%%*% / 


vo id D i sp 1 ay__3ystem_ba i ns ( vo id) 


i nt 
char 
int 
i nt 


done_f lag p 
c p 


max_y -• 16 p 


/% 


= C6 p 

d o n e_ f 1 a g = F A L S E p 
textco 1 or ( WH I TE ) ; 
t e x t b a c k g roun d ( B L A C K ) p 
c 1 rscr ( ) ; 


t e x t c o 1 o r ( B L A C K ) p 
textbackground (WHITE) p 
got ox y ( 1 :L ) p 

cputs ( " SYSTEM GAINS ")p 

gotoxy ( 1 , 2 ) p 

c: p ut s ( ” A Pos i t i on Mot i on Sc ale") p 

gotoxy ( 1 5 3 ) ;; 

c p u t s ( ' 1 B P a s i t i a n Mo t i o n S c a 1 e " ) ; 
gotoxy ( 1 :i 4 ) p 

cputs (" A Velocity Motion Scale"); 
gotoxy ( 1,5) p 

cputs (" B Velocity Motion Scale " ) 5 

gotoxy ( 1 , 6 ) p 

cputs ( 11 A Motor Velocity " ) p 

gotoxy ( 1 , 7 ) p 

cputs(" B Motor Velocity " ) 5 

qotoxy ( 1 H 8 ) p 


c p u t s ( " A T 0 r q ue 
gotoxy ( 1 , 9) p 


" ) P 

c p u t s ( " E< Tor q u. e 
gotoxy { 1 , 10 ) p 


" ) ; 

cputs ( " A Pos i t i on 

" ) 5 

gotoxy ( 1 , 11 ); 



cputsC B Position 

" ) ? 

gotoxy ( 1 , 12 ) p 
c p u t s ( 1 ‘ A 0 u t p u t 
gotoxy ( 1 m 13 ) p 

Ve 1 oc i ty 

"> P 

cputs ( " B Output 
gotoxy ( 1 , 1 4 ) p 

Ve 1 oc i t y 

“) ? 

c p u t s ( 1 ’ iJ i r e c t i 0 n 

»* \ 0 

/ ft 

qotoxy ( 1 ,15) p 
c p u t s ( 2 1 J 0 y s t i c k 

Yaw Gain 

n ' } n 
/ « 

gotoxy (1,16); 
c p u t s ( " J 0 y s t i c k 
gotoxy ( 1 , 17 ) 5 

Pitch Gain 

r> ) ” 

cputs ( " 
gotoxy ( 1 , 1 S ) p 


‘ f ) § 

cputs ( " 


,f ) 5 


" ) S */ 


/^reserved*/ 


gotoxy ( 1 , 1 9 ) : 
cputs f " 
qotoKy ( 1 , 2.5 ) 5 

cputs ("ENTER ’ E ’ TO EXIT ' C ’ TO CHANGE A GAIN VALUE 
textcolor (WHITE) 3 
t extbac k g r oun d ( BLACK ) 3 
wh i .1 e (idem e_ flag) 

r 

\. 

got oxy ( ,2 ) 3 
c 1 reol ( ) 5 
got oxy ( x , 2 ) 3 


pr intf ( "X. 2 -f " , 
got oxy ( x , 3 ) ; 
c 1 reol ( ) ; 

MPTR— 

> g n » A_ 

_pos__mot ion_ 

seal e ) 

got oxy { x , 3 ) 3 
pr int-f ( "X „ 2 f " , 

M P TE- 

>gn . B_ 

_pos_mot i. on_ 

sc a 1 e ) 

got oxy ( x 5 4 ) 3 
c 1 reo 1 ( ) 3 
got oxy ( x ,4)3 
pr int-f ( " % . 2-f " , 

MP TR- 

>gn. A_ 

_ve 1 __mot i on_ 

sea 1 e ) 

got oxy ( x 5 ) 3 
c 1 reo 1 ( ) 3 
got oxy ( x , 5 ) 3 
pr int-f ( "X . 2 -F" ,, 
got oxy ( x ,6)3 
c 1 reo 1 ( ) ; 

MPTR- 

>gn „ B_ 

_ve l_mot ion__ 

sc a 1 e ) 

got oxy ( x ,6)3 
p r int-f ( 2-f" , 

MPTR-- 

>gn . A_ 

_motor_vel ) 3 


gotoxy ( x , 7 ) 3 
c: 1 reo 1 ( ) 3 
gotoxy ( x ,, 7 ) 3 
pr irttf ( "X . 2 -F" , 
gotoxy ( x , 8 ) ; 
clreol ( ) ; 

MPTR- 

> g r> . B_ 

_motor_vel ) ; 


gotoxy ( x , 8 ) 3 
pr int-f ( "X . 2-f" , 
gotoxy ( x , 9)3 
c 1 reol ( ) 3 

MPTR-- 

> g n » A_ 

.torque ) 3 


gotoxy ( x , 9 ) 3 
pr int-f ( "X . 2-f" , 
gotoxy ( x ,, 1 0 ) ; 
c I reo 1 ( ) 3 

MPTR- 

> g n . E<_ 

.torque) 3 


gotoxy ( x ,, 10 ) 3 
pr int-f ( "X. 2 f " , 

MF'TR- 

>gn .. A_ 

_posi t i on ) 3 


gotoxy ( x , 1 1 ) 3 
c .1 reo 1 ( ) 3 
gotoxy ( x 1 1 ) 3 
printf ( "X » 2-f " , 
gotoxy ( x , 12) 3 
clreol ( ) 3 

MPTR-- 

>gn , Ey 

.position ) 3 


gotoxy ( x 12) ; 
printf ( "X. 2 f " , 
gotoxy ( x , 1 3 ) 3 

MPTR-- 

>gn « A_ 

_output_vel ) 


c 1 reol ( ) ; 
gotoxy ( x , 1 3 ) 3 
printf ( "X. 2 -F " , 
got oxy ( x ? 1 4 ) 3 
c 1 reol ( ) 3 

MPTR- 

>gn . B_ 

_ou.tput._vel ) 

j 

gotoxy ( x , 14 ) 3 





p r intf ( "%d " , MF’TR->g 

n » d i rect i on ) 3 


g 0 1 0 x y ( x 1 5 ) 3 





c 1 reol ( ) 3 





gotoxy ( x , 15 ) 3 





p r i n tf ( " X .. 2f " , 

MPTR-- 

> j y ■ >l 

_ga in ) 3 



g o t o x y ( x , 1 6 ) 3 
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OF POOR QUALITY 


gotoxy ( x . i 6 ) p 

p r i n t. f ( ' ‘ = 2 f 1 ! , M P T ft ~ > 

gotaxy { x , i 7 ) p 

c 1 real ( ) p 

g ataxy ( ;■! 17 ) p 

pr intf ( ""/.d " , MPTft->gn 

goto x y ( x » 1 8 ) p 

c 1 real ( ) p 

gotoxy ( x 1 8 ) p 

printf ( "’Ad" , MPTR->gn 

gotoxy ( x , 19 ) p 

c 1 real ( ) p 

gotoxy ( x , 19) p 

pr i ntf ( "’Ad " , ' MPTR->gn 

del ay (500) r, 

if ( k b h i t ( ) ) 


j y ■ y_gain ) 


) 5 


- ) p 


. ) 


H 


%/ 


/^reserved#/ 


c = getch ( ) p 

if ((c == J E : ) ! i (c =~ ' e ? ) ) done__flag - TRUE p 

else if ((c =- ’ C ’ ) 11 (c r 'c:‘)) Mod__Ga in ( max_y ) p 

text co lor (WHITE) p 
t e x t b a c k g r o u n d ( B L A C l< ) p 
c 1 rscr ( ) p 



* FILE s NASA5.C 

t DATE? August 4 , 1990 

% 

t ROUTINES 
■S' Mot i on_Done 

t Get__Command__Pas i t ion 

& E r r o r__Chec k 

* Cal cul ate__Pos it i on 

t C ale u .1 a t e__ D r i v e 

* Command_0perat ion 

>K N e u t r a 1 _ C- o m m and 

t M e u t r a l_0per at i o n 

$ 
i< 

# i n c I u ci e 1 1 e x t. data . h “ 

# inc 1 u ci e 1 1 n a s ade-f . h " 

# i n c 1 li d 6 < d o s » h > 

# i n c 1 u d e < conio. h > 

# i n c 1 u c:i e < s t. d i o . h > 


/ # if: t # % 1 1 * # # >k % * % % ix % t % %%%%% 

$ DATA 

% t % % % 1 1 %%%%%%%%%%%% & %%%% / 


i n t 
i. n t 
int 

unsigned int 


sof t__p i tch__-f 1 aq ; 
sof t_yaw__-flag 5 
ad__chec k 5 
counter ; 


/ 1 % $ %. t >S; %. t & % $ >K 4 # % % % % % % % t % % 

% routine to check when joint motion is done 
% joystick is no longer active or on commanded position 
% as been reached 
% % $ t % % %%%%%%%% % %%%%%% % % % / 


vo i d Mot i on__Done ( vo i d ) 

int c h e c k p 5 c h e c k y ; 


i t c h ) 


•if ( ( abs ( MF’TR->py „ p i tch_pos - MR ! R~>ds = -f i nal __p i tch ) ) <= MPTR->sp . delta 

. check p - TRUE? 
e .1 Si e c h e c k p — F A L. S E ; 

if ( (abs ( MPTR->py . yaw_pos - MPTR- >ds „ Final_yaw ) ) <= MF’TR— >sp . del ta_yaw ) 
c h e c k y = TRUE; 
else cheeky = FALSE; 

if (eheckp && cheeky && (MPTR->ds. counter >= MPTR~>ds . steps ) ) 


RUN_ARM = FALSE; 

ERR0R__FL.AG = M 0 R M A L_ S H U T D 0 W N ; 



/ # % & t # t K 1 1 -t % t # 1 1 1 % & 1 1 * 1 1 & 
t routine to get desired position of the joint 
it. % % % t ii t & # 1 1 1 $ % % t % # % % % % t & / 


vo i d Get_Command_Pos i t i on ( vo i d ) 

v. 


•float 
f 1 oat 
•float 
int 


va 1 ue 5 
1 ow_ limits 
h i q h_ limit? 
moves ; 


short 

unsigned int 
i n t 


temp ; 
steps ; 
•i" i a g r. 


MPTR—>ds. counter = 0; 
textco lor ( BLACK ) ; 
textbackground ( WHITE ) ; 
do 

■flag = TRUE; 
gotoxy ( 20 ,15) ; 

cputs ( " ENTER DESIRED MOVE TIME (seconds) 

goto x y ( 5 8 , 15) ; 

sc an f ( " %f " ? S<va 1 ue ) ; 

if (value > 0.0) flag - FALSE; 

while (flag); 

M P T R -•- > ds.time - v a lue; 
d o 

,r 

flag = TRUE; 
gotoxy ( 20 , 16 ) ; 

cputs (" ENTER IN DESIRED PITCH ANGLE 

g o t o x y ( 5 8 ,, 1 6 ) ; 

sc. an f ( " %f " ,, ?< va 1 ue ) ; 

low_limit ~ (( float )( MPTR-->sp . p it.ch__ lo_al arm - MPTR— > 
utral ) / 65536,, 0); 

low_. limit = ( low_ limit t 360.0) — 360.0; 
h i.gh__.l irnit ~ (( float )( MPTR—>'sp . p i tc.h_h i__a .1 arm •■•■ MPTR-- 
eut r a 1 ) / 65536 ,. 0 ) ; 

hiqh__ limit = high__limit >K 360.0; 

if ((value < high__l imit. ) £<& (value > low_limit)) flag 

*V 

wh i 1 e ( f 1 ag ) ; 

MPTR~>ds .pi tch_ang le = value; 
value = (value # 65536.0) / 360.0; 

MPTR— >ds . de 1 ta_p i tch_pos = (int) value; 

MPTR— >ds . f i nal_p itch = ( unsigned int ) ( MF’TR->sp „ p i tch_neut ral 

. d e 1 1 a_p i t c h_p os ) ; 
do 

r 

flag = TRUE; 
gotoxy ( 20 .17); 

cputs ( ” ENTER IN DESIRED YAW ANGLE 

g o t o x y ( 5 8 ,, 17) ; 

sc an f ( 11 %f " ? & va 1 ue ) ; 

1 o w_ 1 i m i t = ( ( f i o a t ) ( M P T R ■- > s p „ v a w_ I o__ a 1 a r m -• M P T R -- > s p 

1 ) / 65536 . 0 ) ; 

1 ow_ limit = (low_ limit Y 360.0) ■- 360.0; 
h i g h_ I i m i t = ( ( f I o a t ) ( M P T R - > s p . y a w_ h i __ a 1 a r m -- M P T R -•- > s 

a .1 ) / 65536 . 0 ) 

h i g h_ 1 i m i t r - h i g h_ limit # 3 60 . 0 ; 

if ((value < high_ limit) &S-: (value > low_limit)) flag 


) s 

sp . p i tch_n 
>sp . o i tch__ 
= FALSE; 

+ MPTR— >d 
) 5 

. yaw_neut r 
p . yaw_neut 



while (flag) ; 

MPTR— >ds . yaw_ang 1 e = values, 
value = (value % 65536 0 ) / 360.0; 

MPTR— >ds . del ta_yaw_pos = (int) value? 

MPTR— >ds . f i nal_yaw = (unsigned int ) ( MPTR->sp . yaw__neut ral + MPTR— >ds » del t 
a_yaw_pos ) ; 

MPTR— >ds . steps = (unsigned int) (MPTR— >ds . time # (float ) FREQUENCY ) ; 

MPTR— >ds . p itch_step = (float) ((( float ) MPTR— >ds . final_p itch — (float ) MPT 
R->py . p i tch_pos ) / ( f 1 oat ) MPTR— >ds . steps ) ; 

MPTR->ds . yaw_step = (float) ((( float ) MPTR— >ds . final_yaw - ( fl oat. ) MPTR- 

>pv . yaw__pos ) / ( f 1 oat ) MPTR->ds . steps ) ; 

MPTR->ds . p i tch_pos = : MPTR— >py . p i tch_pos ; 

MPTR— >ds . yaw_pos = MPTR— >py . yaw_pos ; 

MPTR— >od . p i tch_pos = MPTR->ds . p i tch_pos r, 

MPTR->od . yaw_pos = MPTR->ds. yaw_pos; 

MPTR— >ds . p i t ch_star t = MPTR->py . p i tch_pos ; 

MPTR->ds . yaw_ star t = MPTR->py . yaw_pos ; 

g ot o x y ( 50 , 24 ) ; 

cputs( "WORKING" ) ; 

t e t c o .1 or ( W HITE) ; 

t e >: t b a c k g r o u n d ( B L A C i< ) ; 

g a t o y ( 20 ? 1 5 ) ; 

c 1 reo 3. ( ) ; 

q o t o y ( 20 „ 1 6 ) ; 

c 3. reo 1 ( ) p, 

g ot o y, y ( 20 ? 1 7 ) ; 

c 1 reo 1 ( ) ; 


/ 1 # # # ♦ 1 1 1 # 1 ♦ t ###♦## 5i< t # * # # 

t r a u t i n e t o c h e c k f o r p orp e r a r m ( j o i n t ) o p e r a t ion 

# check motor and joint limits 

# $ % t % % t % % % % % t 1 % t % % % t * # * t / 


v o i d E r r o r _ C h e c k (void) 

<r 


if 

( MPT R— >py . p .i t ch__pos 

> MPTR->sp «pitch_hi_l imit ) 

/♦check for#/ 


ERR0R_FLAG = P_ 

_H 1_L I M I T ; 

/ * f a t a 1 e r r o r s t / 

if 

( MPTR— > p y . p i t c h_p os 

< MP TR - > s p . p i t c h__ 1 o__. 1 i m i t ) 



ERRQR__FLA6 = P_ 

_LQ_L IMIT; 


i f 

( M P T R — > p y . y a w_ p o s > 

MPTR - >sp .. y aw_h i_ 1 i m i t ) 



ERROR FLAG Y 

_HI_ LIMIT ; 


i f 

( M P T R — > p y . y a w__ p o s < 

MPTR->sp . yaw_ 1 o__ 1 i m i t ) 



ERR0R_FLAG = Y_L0_L I M IT; 
if (ERR0R_FLAG != FALSE) RUN_ARM = FALSE ; 
if ( MPTR— >py . p i tch__pos >== MPTR— >sp .pitch_hi_alarm) 
MPTR— >sp . s 1 i m i t_p i ten -- i ; 
if (MPTR— >py «pitch_pos <= MPTR— >sp . p i tch__lo_alarm ) 
MPTR— >sp . s 1 i m i t_p itch = - 1 ; 
if ( MPTR— >py . yaw_pos >— MPTR— >sp .yaw_hi_alarm) 
MPTR— >sp . s 1 i m i t_yaw — .1 ; 
i f ( M P T R — > p y . y a w_ p o s < = M P TR — > s p y a w_ 1 o_ a 1 a r m ) 
MPTR— >sp « s 1 i m i t__yaw = - 1 ; 


/ % % % % ;fc >fc % % % t % # # % % t % t%t% % % % 

% r o u t i n e t o find t h e n e x t d e s i r e d join t p o s i t i o n 

% input from commanded position or the joystick 

% % % an $ >v. % jfc # # % % % % % # % % % % # & % % / 

v o i d C a 3. c u 1 a t e__ P o s i t i o rt ( v o i d ) 

jr 

float temp; 


i f ( Si P T R > d s.co u n ter < s= M P T R — > d s s t eps) 


temp = ( MPTR— >ds . p i tch_step # (-Float) MF'TR->ds . counter ) + (float 
) MPTR— >ds . p i tch_start g 

MPTR->ds « pitch_pos = (int) temp? 

t e m p r ~ ( M P T R — > ds.yaw_step t ( -F 1 o a\ t ) ii P T R — > ds . c a u nte r ) + ( f .1 o a t } 
MPTR— >ds . yaw_start ; 

MPTR— >ds . yaw_pos = (int) temp; 

/#print-f ( "Xu Xu.\n " , MPTR->ds . p i tch_pos ,MPTR~>ds . yaw_pos) %%/ 


M P T R - > ds „ count e r + = 1 ; 

if ( MPTR— >ds .counter == (2 # MF‘TR->ds . steps ) ) 

RUM_ARM = FALSE ; 

if ( MPTR— >sp . si imi t_p .itch != 0) ERR0R_FLAG = SQFT_L I M IT _P 5 
else if (MPTR— >sp .si imit_yaw I = 0) ERR0R_FLAG = S0FT_LIMIT_Y 3 
else ERR0R_FLAG = TIME_0UT; 


MPTR->ds . p i tch_vel 
M P T R > ds. y a w_ v e 1 
MPTR— >od . p i t ch_pos 
M P T R •- > a d „ y a w_ p o s 


= ( int )( MPTR— >ds . p i tch_pos - MPTR->od «p.itch._pos) 3 
-• ( i n t ) ( M P T R — > d s „ ya w_ p o s — M P T R — > o d „ y a w__ p o s ) g 
— MPTR— >ds . p i. tch__pos g 
-■ M P T R -• > d s „ y a w_ p o s g 


/ # * 1 1 % % % « % %*%%%% % %%%% % % % % 

% routine to find the motor input (drive) values based 
t on system conditions, angles desired and angles true 
%%%%%%%%%% % % %%■%%%%%■'!(■%%%% / 


v o i d C a 1 c u 1 a t e_ D r i v e (voi d ) 


float 

d i f f a , diffbg 


f 1 oat 

d i f f av , d i f f b v g 


float 

tacha, tachbg 


f 1 oat 

d r i vea , d r i veb g 


i p, t 

pitch, yawg 


int 

pitchv, yawv g 


/ 1 f i n d i 

f so f t limits are 

in effect#/ 

if ( MPTF 

: -• > s p .. s 1 i m i t __ p i t c h 

! = FALSE) 


if ( sof t_p i tch_f lag == 0) 

sof t_p i t c h__f lag = 1 g 

MPTR— >od . si imi t_p itch = MPTR— >py « p itch_pos g 

J 

else if (MPTR— >sp . si imi t_p itch — = 1) 

X 

if ( MPTR— >py . p .i tch__.pos >= MPTR->od .. s 1 imi t.___p i tch ) MPTR >d 

s . pitch_pos = MPTR->od .si imit_pitch g 

J' 

0 I se 


s . pi tch_pos - MPTR- 


if ( MPTR— >ds . p i tch_pos 
od . s 1 i rn i t_p i t ch j 


<= MP ! R — > o d .si imit_pitch ) MPTR->d 


else soft_pitch_f lag -- Og 
i f ( M P T R -- > s p .. s 1 i m i t __ y a w ! = F A L S E > 

'L 

A _C. f t~ 


X i- 


n \ 


soft_yaw_f lag = 1; 

MPTR— >od n si i mi t_yaw = MPTR— >ds „ yaw_pos ? 

else if (MPTR— >sp«slimit_yaw == 1) 

if (MPTR— >ds • yaw_pos >= MPTR->od ■ si imit_yaw) MPTR->ds.ya 
w_pos - MPTR— >od »sl imit_yaw 5 

else 


i-f (MPTR— >ds. yaw_pos <= MPTR— >od . si imit_yaw ) MPTR->ds»ya 
w_pos - MPTR->od . s 1 i mi t_yaw ; 

•V 

J 

else soft_yaw_f lag = 0 ; 

/#find motor A drive signal#/ 

/#find motor B drive signal#/ 

p i tch 
yaw 

p i t chv 
yawv 
cl :i 

d i f f b 
d i f f av 
d i f f b v 
tacha 
tachb 
dr i vea 

drived = diffb + diffbv -- tachb? 

/#pr int-f ( "drxvea/fo Xf ?/f\n", drives, drived) 5 #/ 

MPTR->ma . mot_dr i ve = ( ( ( int ) (drives) ) % MPTR->gn . d irect ion ) + 2048 5 
MPTR- > mb . mot _dr i ve - (((int) (driveb)) % MPTR->gn . d irect ion ) + 2048? 

/#pr int-f ( "of a Xf dfb Xf d-fav Xf dfbv Xf dva Zf dvb Xf \n " , d iff a ? d i ff b , d i f-f av , d i f f 
b v ,, d r i vea ,, d r i veb ) ? %/ 

/#pr int-f ( "dr ive a Xd b Xd\n 11 s MPTR->ma. mot_dr i ve , MPTR->mb . mot__dr ive ) r, %/ 


= MPTR->ds « p i tch_pos — MPTR— >py.pitch_pos; 

= MPTR— >py . yaw_pos - MPTR->ds » yaw_pos ; 

= MPTR->ds. p i tch_vel - MPTR->py .pitch_vel 5 

- MPTR->ds « yaw_vel - MPTR->py . yaw_vel 5 

- - ( MPTR~>gn . A_posi t ion t (-float) (pitch •+• yaw))? 

~ MPTR— >gn . B_posit ion % ( -float) (pitch - yaw)? 

- ( MPTR- >gn . A__ out put _ve 1 % (-float) (pit. chv + yawv))? 
= ( MPTR->gn „ B_output_ve 1 % (float) (pitchv - yawv))? 
-• MPTR— >gn « A__motor_vel t (-float) ( MPTR-~->ma . tach ) ? 

== MPTR- > g n . B__ m otor_vel # (float) (MPT R -- > mb.tac h ) ? 

= d i f f a + d i f f a v - t a c h a ? 


/ # % % % %%%%%%%%%%%%%%%%%%%% 
t performs the moving of the arm 
% given the final pitch and yaw angles 
% w i 1 1 c h e c k f o r e r r o r s a n d f i n a 1 pas i t i o n 
# % # % % % / 


v o i d C o m m a n d___ 0 p e r a t i o n ( v a i d ) 

Set.__Cl ock_Up ( ) ; 

E n a b 1 e__ A D__ I n t e r r u p t ( ) ? 

I n i t i a l_System ( ) ? 

Get_Command_Posit ion ( ) ; 
ad _ check = O? 

U n 1 o c k_ Bra k e s ( ) ; 
wh i 1 e ( RUN_ ARM ) 

r 

u 

ad_check++ ? 
if (ad_check > 15000) 
t 

ERRQR_FLAG = AD_FA I L ? 

RUN _ ARM = FALSE q ORIGINAL PAGE 2S 
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C a 1 c u I a t e__ P a s i t i a n ( ) p 
E r r o r__Chec k ( ) 5 
C a i c u 1 a t e_ D r i v e ( ) 5 
MotDr_Drive ( ) ; 

Mot ion_Done( ) 5 
Data_Record ( ) 5 
ad__check : = Op 
ST ART_LOOP = ' FALSE 5 


Lock_Brakes ( ) 5 
Unset__Clock ( ) 3 
Disp lay_Er ror ( TRUE ) ; 
Data__Save( ) 5 


/ t jjc sf; # t # t # t t t t % t t t % t %%%%%% 

% routine to get neutral position of the joint 
if. :s( 4 % yf. # 1 t # t if. % * t t 1 1 >f % t % % t / 

vo i d Meu.t r a 1 Command Pos i t i on ( vo i d ) 


f 1 oat 
float 
•f 1 oat 
sh o r t 

unsigned int 


va 1 net 
va 1 uep 
valuey 
temp 5 
steps 5 


= o „ o ; 


t extcol o r ( B L. A C K ) 5 
t e t b ac k g r oun d ( WH I TE ) ; 
g a t o >; y ( 5 0 „ 2 4 ) 5 
cputs ( "WORKING" ) ; 
text co lor (WHITE ) 5 
t e t b a c k g r o u n d ( B L A C l< ) 5 
M P T R > d s . t i m e - v a 1 u. e t ; 

MPTR->ds . p i tc:h_ang le = MPTR~>py . p i tch_ang $ t/ /tv a 1 u.ep %/ 
valuep = (values % 65536-0) / 360.0 5 
M P T R > d s . d e 1 1 a__ p i t c h __ p o s — ( i n t ) v a 1 u e p ; 

MPTR~>ds . f inal__p itch = (unsigned int ) (MPTR 
. d e 3. t. a___p i t c h_p os ) 5 %/ 

MPTR >ds.final_pitch = (unsigned int) (MPTR 

M P T R ■ - > d s .. y a w__ a n q 1 e = M P T R ■ - > p y . y a w__ a ng; t / 

( va 1 uey t 65536 . 0 ) / 360 . 0 ; 
d e 1 1 a_ y a w_ pos = ( i n t. ) v a 1 u e y 5 

yaw = (unsigned int) (MPTR 


/ # 
/* 


/ 1 
/% 


s p . p i t c h._ n e u t. r 1 + M P T R > d 

5 p . p i t c h_ n e u t r a 1 ) ; 

/ 1 v a i u e y t / 


valuey = 

MPTR > d s . 

M P T R — > d s . f i n a 1 _ 
a_,.yaw_pos ) ; %/ 

M P T R -- > d s . f i n al_ 
M P T R - > d s „ s t e p s 
MPTR™ > ds . p i t c: h_ 


yaw = (unsigned int)(MPTR- 
= (unsigned int) ( MPTR— >ds 
step = (float) ((( float ) MPTR->d« 


• s p . y a w_ n e u. t r a 1 + M T R — > d s . d e 1 

•sp - yaw__neu.tr a 1 5 ; 
t i me % ( f 1 oat ) FREQUENCY ) 5 


R~>py .. p i tch__pos ) / ( f 3 . oat ) Mh'TR->ds . steps ) ; 
>py 


MPTR- 
■ yaw_pos ) 


ds . ya.w_step 
(float ) MPTR- 


= ( f 1 oat ) ( ( ( f 1 oat ) MPTR- 

ds „ steps ) ; 


>di 


, f i n a 1 __p i t c h — ( f 3 . oa t ) MF : ’ 
. f i n a 1 __ y a w - ( f 1 o a t ) M P T R 


MPTR— 

> d s . p i t c h_ p 0 s — 

MPTR— > 

p y . p i t c h_p os 5 

MPTR™ 

> d s- . y a w_ p 0 s = : 

MPTR— > 

py . yaw_pos 5 

MPTR™ 

> 0 d . p i t c h __ p 0 s ='• 

MPTR— > 

ds»p itcn_pos 5 

MPTR-- 

> 0 d „ y a w_ p 0 s = 

MPTR— > 

ds . yaw _pos r, 

MPTR™ 

> d s . p i t c h_ _ s t a r t 

= MPTR 

- > p y . p i t c h_p 0 

MPTR— 

> d s . y a w_ s t a r t 

— MPTR 

- > p y . y a w_ p o s 5 


/ 1 1 1 1 1 >K t $ t % t T »■ t % 1 1 # t % t 
t m o v e t k 1 e j o i n t t o t he n e u. t r a 1 p o s i t i o n 

1 1 # t >K t :{; # 1 1 % % % )K % % % % % t # 1 1 / 


vo i d 


N e u t r a i ___ U p e r a t i o n ( v o i d } 


Set__Clock_Up ( ) 5 

Enab 1 e_AD_ Inter ru.pt ( ) ; 

I n i t i a I_Syst em ( ) ; 
ad_ check - Op 

Neutral__Command_pQ 5 i t ion ( ) 5 
Un 1 ock_E<r akes ( ) q 
while (RUN_ ARM) 

ad_chec k++ ; 
i -f (ad_check > 1 5000 ) 

ERRQR_FLAG = AD_FA I L 
RUN_ARM = FALSE s 


wh i 1 e ( START__L00P ) 


6 et_ Joi nt_Dat a ( ) ; 

Ca 1 c u 1 at. e__Pos i t i on ( ) 
Error_Check( ) ; 
Calculate_Dr i ve ( ) ; 
Mot or_Dr i ve ( ) 5 
Mot i on_Done ( ) 5 
Data__Record ( ) 5 
ad_check — Os; 

ST ART_L00P = FALSE; 


Lock_Brakes( ) q 
Unset_Clock{ ) q 
D i s p 1 a y __ E r r o r (TRUE) 5 
Data_Save ( ) 5 



/ & t %%%%%%%%%% % % % t % % t * ## # s $ 

* FILE: NASA6 . C 

$ DATE: July 28* 1990 

>ft 

* ROUTINES 

* Mot. o r_ I n i t. i a 1 

* Motor__Sim 

* WARNING THIS ROUTINE WILL NOT WORK WITH THE NEW CONTROL 

>K SYSTEM 

% % 1 1 % ^ $ $ t # t % % % % % % % % % % % % % % / 

#inc luce "ext data « h " 

# .i nc 1 tide " nasadef * h 11 


i n t mot_d r i ve__a , mot_d r i ve_b 5 

float rpc_motor_a, rpc_motor_b ; 
float total_motor_a = 0 * 0 ; 

■float total __motor__b = O.O 5 

float theta_a, theta_b 5 
f 1 o a t t h e t a_ g e a r_ a , t h e t a__ g e a r __ b ? 

f 1 o a t. t h e t a_ p y _ a , t h e t a_ pv.b ; 

i n t t a c h_ a , t a c h__ b ? 

float pitch_angle, yaw_anqle; 


.i n t 


p i tch_res 

yaw... res 


long 

i. n t 

de 

s_p itch 3 

des_yaw ? 

int 


old_p itch_ 

pas, old 

_yaw_pos ; 

i n t 


1 0 0 p 0 ? 



c h a r 

dump ; 




f 1 oat 

ternp_p , 

temp_y 5 



f I oat 

3c 1 


0 . 000 1 63 

? / >■ 35 0 0 0 / 6 0 / 1 0 0 / 2 0 48#/ 

float 

k :2 


0 * 00488 5 

/ # 2 O v / 4 O 9 6 # / 

f 3. oat 


— 0 11 00 

'5493 ; 

/ 1 3 6 0 / 6 5 5 3 6 # / 

f 1 oat 

3c 4 

— 

1 5000 . 0 ? 

/#100hz#60#/ 

f .1 oat 

3c 5 


500 » 0 ; 

/ # 5 0 0 r p m 1 v 0 u t 

i n t 

gear 

s= 

90 ? 


f 1 oat 

P y_g ear 

- 4 « 3 5 



f I oat 

t i me__d i v 

9 c ;o - 

A-iJt' q 

/ * 1 00 h s # / 

i n t 


done ? 



f 3. oat 

gain_pos 

= 0 * 8,1 



f 1 oat 

ga i n_ve 1 

= 0.0 5 



f 1 oat 

gain_tac 

h — 0 * 6 ? 




int desire_pitch, desire_yaw; 

float step__pitch, step_yaw; 


vo i d Mot or_ I n i t i a 1 ( vo i d ) 


loop = 0; 

old_p i tch_pos = MPTR— >py * p i tch_pos ; 
o 1 d_ y a w__ p o s : = M P T R -- > p y » y a w_ pas j 
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3 i m ( va i d } 


void Motor £ 


sp . j 


loop = loop + 1 ; 

rpc_motor_a = (MF'TR— >ma . mot_dr i ve -- 2048) # k 1 ; 
rpc_inotor_b = (MPTR— >mb . mot_dr ive — 2048) t k 1 5 
total_motor__a ~ total_motor_a + rpc_motor_a 5 
total_motor_b — total_motor_b + rpc_motor_b ; 

MPTR— >ma . res_ang = total_motar_a; 

MF'TR->mta » res_ang = total_motor_b ; 

MF'TR- >ma „ tach = (int) ( ( ( ( rpc_motor_a * k4) / k5) / k2) ) ; 

MPTR->mb » tach = (int) ( ( ( ( rpc_motor_b # k4) / k5) / k 2 ) ) ; 

if (MPTR— >ma . tach > 4096) MPTR— >ma . tach - 4096? 

else i-f (MPTR— >ma . tach < 0 ) MPTR— >ma . tach = 0? 

i-f ( MPTR— >mb . tach > 4096) MF'TR— >mb . tach = 4096; 

else if (MPTR->mb„tach < 0) MPTR- > mb „ tach = 0; 


theta._a = 

t a t a 1 __ m 0 1 . 0 r _ a 

* 360; 

theta_b = 

tot a 1 motor b 

* 360 ; 

theta_gear_a - 

1.0 # theta_a 

/ gear; 

theta_gear__fo = 

1 .0 t theta__b 

/ gear ; 

t h e t a__ p y_ a = 

theta_gear_a 

/ py._.gear; 

theta_py__b = 

t bet a__g e a r_b 

/ py_g ear ; 

pitch_angle - 

( t h e t a py_a 

theta_py_b ) / 2; 

yaw___ang 1 e = 

( t h e t a__ p y_ a + 

t h e t. a_ p y_ b ) / 2 ; 

M F : ‘ T R -- > p y . p i t c: h_ 

_pos -• (unsigned int) (pitch_angle 


tch_neut ral ; 

MF'TR!— >p y o yaw p os - (unsigned int) (yaw_angle / k3) + 


+ MPTR— > 
MPTR— >sp 


y a w._ neutral ; 


/ * p r i n t f ( " 1 p = X u , dr- X d X d 

"A u \ n 1 ' , M P T R - > ds.c o u n t e r , M P T R - > m a m o t _ d r i v e 
MPTR- > mb . tach , MPTR~>ds - p i tch_pos , MF'TR— >ds 


y . yaw_pcss ) 5 


scanf ( " "Ac 


ta= "Ad "Ad dp= : Xu dy== Xu pi= Xu ya— 
MPTR- > mb .. mot__dr i ve 3 MPTR->ma .. tach f 
yaw_pos , MPTR->py u p i tch_pos , MPTR >p 


#/ 


S-.dump ) ; 




/%*%**%**%*%%%%*%**%%**%*% 

# FILE! NASA? „ C 

# DATE; August 14,, 1990 

# 

# ROUTINES 

& J a y_ M d t i a n _ D o n e 

$ Jay_Er ror._Check 

® Gjet_ J oy_Pos i t i on 

t Read__Joyst ick 

# J o y stic k_ 0 p eratio n 
% 

# 

$ $ # $ )!< 3 jC # # $ # )j( He # Y # $ # 1 1 # Y $ # % % / 


# i n c 1 u d e "ex t d a t a . h 1 1 
# i n c 1 u d e " n a s a d ef «h" 

# i n c 1 u d e < d os . h > 

# i n c 1 u d e < conio.h > 

# i n c I u d e < s t d i o „ h > 

/ % t % % & % % % %%%%%%%%%%%%% % % % 

* DATA 

% % %%%%%%%%%%%%%%%%%% % % % % / 


i n t 

view flags 

i n t 

neu.tr a l_x ; 

i n t 

neui r a l__y ? 

i n t 

j ad . check ; 

i n t 

butt, on 1 ? 


/ 1 1 % t $ $ 1 1 1 % % t % % % % % % %%%%%% 
t r o u t i n e t a c h e c k w h e n j o i n t m o t i o n is do n e 
% joystick is no longer active or on commanded position 
# as been reached 
t % % % >i< % %&%%%%%.%%%%%*%%%%% / 


v o i d J o y_ Not i o n__ D o n e ( v o i d ) 


i f ( MPTR-> j y „ but ton_2 ) 

r 

RUN_ARM = FALSE? 

ERR0R_FLAG = NORMAL _SHUTDDWN ? 


else if ( ( ERR0R_FLAG >= P_HI_LIMIT) && ( ERRQR_ FLAG <= Y__L0._LI.MIT)) 
RUN ARM = FALSE; 


/ * $ $ % t ttt %%%%%%%%% % % % % 1 1 1 

% routine to check -for proper arm (joint) operation 
t check motor and joint limits 
% t # t Y # % 1 1 % % 1 1 Y 1 1 M & t % ii Y % % / 

v o i d J o y _ E r r o r __ C h e c: k (void ) 



if ( MPTR-->py » p i. tc.h_.pos > MF'TR->sp » p i tch__h i_l imi t ) /ftcheck -For#/ 

E R R 0 R_ F L A S = P_HI_LIMIT; /#fatal error 

i-f ( MPTR— >py » p i tch_pos < MPTR— >sp . pitch_lo, limit) 

ERRGR_FLAG = P_LO_LIMIT; 
if ( MPTR— >py . yaw_pos > MPTR— >sp „ yaw_h i_l imi t ) 

ERROR_FLAG = Y_HI_LIMIT; 
i f ( MPTR->py yaw_pos < MPTR— >sp . yaw_ 1 o_ limit) 

E R R 0 R_ F L A G = Y_ L 0_ LIMIT; 

i-f ( MPTR— >py . p i tch_pos >= MPTR— >sp . p i tch_h i_alarm ) 

MPTR— >sp « si imi t_p itch = 1; 

ERROR_FLAG = SOFT_LIMIT_P; 

J 

else if- (MPTR->py .pitch_pos <= MPTR~>sp « p i tch_l o_a 1 ar m ) 

MPTR— >sp . si imi t_p itch = — 1 ; 

ERRDFL.FLAG = SOFT_L I M I T_P ; 

“r. 

J 

e 1 se MPTR— > sp » s 1 i m i t_p i t c h = F ALSE ; 

if ( MPTR— >py « yaw_pos >= MPTR->sp . yaw_h i_alarm) 

MPTR— > sp .slimi t_y aw = 1 ; 

ERROR_FL AG = SOFT_L I M I T_Y r, 

J 

else if ( MPTR— >py . yaw_pos <= MPTR— >sp . yaw_lo_alann ) 

# r 

MPTR— > sp . s 1 imi t_y aw -• - 1 ; 

E R R 0 R__ F L A G = SOFT_LIMIT_.Y ; 

else MPTR— >sp » si imi t__yaw — FALSE; 


/ i< % t # t t t xttt % 

% routine to get initial position of the joint. 
% %%%%%%%% % % % % % % % %%%%%% % % / 


vo i d Get_ J oy_Pos i t i on ( vo i d ) 

irrt gameport = : 0x0201 ; 
i n t c o u n t e r x ? c a u. n t e r__ y ; 
i n t tot a 1 __ x ? tot a l_y ; 
int loop; 

unsigned char game; 
unsigned char (itask_x — 0x01; 
unsigned char mask_y = Ox 02; 

tota.l_x - 0; 
totally - 0; 

for (loop = 0; loop <100; ++loop) 

c a u n t e r__ x — 0 ; 
counter_y - 0; 
o u t p o r t b ( g a m e p a r t ? 0 x 0 3 ) ; 
d a 

game = i n d o r t b ( g a m e p o r t ) ; 
if (game & mask_x ) counter_x += 1; 
if (game St mask_y) count er_y += 1; 

Jr 

while {(game S< mask_x ) ! ! (game S< mask_y)); 

tot a I__x = total _x + counter_x; 
total_y = totai__y + counter_y; 

neutral x — total_ x / 100; 
n e u t r a 1 __ y = t. o t a i __ y / 1 0 0 ; 


/ * p r i [ i ut v f ' bu >_ r d . 

/* neutral_x 

/ % ne u t r a I _ y 

/tor intf ( "neutral 


/«U 
22 ;*/ 
22?*/ 
= Xd 


t it;u l r di_y } ; 'r- / 

/ * j us t s e t t o mid p o s i t ion* / 


MPTR— >ds . p i tch_pos — M 
M P T R -- > d s . y a w_ pas = M 

MPTR— >od . p i t ch__pos — M 
MPTR->od u yaw_pos = M 

MPTR— >ds = p i tch_star t = 
M P T R - > d s . y ax w_ start = 

MPTR- > j y . t ot a 1_ x : = 0? 

M P T R — > j y.total_y = 0 ; 
text co lor (BLACK) ? 
textbackground (WHITE) ? 
gotoxy ( 50 , 24 ) ; 
cput.s( "WORKING" ) ? 


% d \ n " 5 n e u t r a 1 __ x 5 
MPTR— >py . p i tch_pos ? 

M P T R -- > p y * y a w_ p o s ; 
MPTR— >ds . p i tch_pos ? 
MPTR— >ds „ yaw_pos ? 

= MPTR— >py . p i tch_pos 
= MPTR— >py . yaw_pos ? 


neu.t ran 1 y ) s %/ 


/ % $ * # $ ;£ $ $ $ ^ % % % % % % % % % % % % % 

% routine to read joystick and convert to joint angles 
* * % t * * * * * >): * * * * * t * * * * * * * * / 

void R e a d_ J o y s t i c k ( v o i d ) 


i n t cj a m e p o r t - 
int deadband 
int counter_x 
u n s i g n e d c h a r 
u n s i g n e d char 
unsigned char 
unsigned char 
unsigned char 
•float temp? 


0 x 0201 ? 

= 1 0 |! 

CDunter_y 
game ? 
mask_x = 
mask_y = 
mask_l = 
mask 2 = 


0x01 ? 
0 x 02 ? 
0x10? 
0 x 20 ; 


counter_x = 0? 
counter_y = 0? 
b u 1 1 o n„ 1 = F A L S E ? 

M P T R - > j y b u 1 1 o n__ 2 - F A L S E ? 

Dutpoi-tb ( gameport , 0x03 ) ? 
d o 

g a m e - i n p o r t b ( g a m e p a r t ) ? 

IT (game & mask _x ) counter_x += 1? 
i-f ( game &. mask_y) counter_y •+•= 1? 

while ((game S< mask_x) ! i (game 8< mask_y ) i j 
/*pr i nt-f ( " x ™ Xd y = Xd \n" , counter x, caunter_y ) ? %/ 


if (game 

mask_l ) button 

_1 = FALSE? 

else button 

,_1 =“ TRUE ; 


if (game 8< 

mask_2) MPTR— > 

jy » but ton_2 

else MPTR— > 

j y „ but. t a n__ 2 = 

TRUE ? 

if (button 

1 ) 



if (view flaa 


TRUE ) 


v i ew__f lag = FALSE; 
U n 1 o c k B r a k e s ( ) ? 


/" * p r i n t T ( " x 


counter___x = counter_x - neutral_x? 
countsr_y = : counter^'/ ■•••• neutrally? 

Xd y = Xd \n", cou.nt.er_x,, counter_y) 
i-f (( abs ( counter y)) > deadband) 


ORIGINAL PAGE VS 

OF POOR QUALITY 


i f ( c o u n t e r_y > 0 ) 


c ounter_ y / # 
...-•tart ; 


MPTR— >jy. totally = MPTR-> j y . tot al_y + ((-float) ( 
— dead b a n d * / ) # M p T R — > j y . y _ gain) ; 

temp = MPTR-> jy . total_y + (float) MPTR— >ds » p i tch 

MPTR— >ds . p i tch_pos - (int) temp ; 

J 

else if (counter_y < 0 ) 


counter_y / #+ deadband'#/) 
_start ; 


e 1 se 


MPTR— > j y „ totally - MPTR-> 
# M P T R — > j y . y _ g ain) 5 

temp = MPTR— > jy . total_y + 


jy.total_y + ((float) ( 
( f 1 oat ) MPTR->ds . p i tch 


MPTR— >ds . p i tch__pos = (int) temp 5 


temp = MP ! R-> jy « total_y + (float) MP f R->ds « p i tch_st ar t 5 
MPTR->ds .p i tch_pos = (int) temp 5 
/ 

/#pr intf { "p_pos = !4d " ,, MPTR— >ds.pitch_pos) ; #/ 

if ( (abs(counter_x) ) > deadband) 

jr 

if ( count er_x > 0 ) 


c:ounter_x 
t a r t ; 


counter^;-! 
t a r t ; 




MF'TR- 

>jy. total. _x = MPTR- 

> j y , t a t. a 3. _ x + ( ( f 1 0 a t ) ( 

/*■ 

- deadband#/) 

# MPTR-> jy « 

x__gain ) 5 




temp 

=""mPTR-> jy . total_x 

+ ( f 1 0 a t ) M P T R - > d s .. y a w__ s 



MPTR- 

>ds . yaw_pos - ( i nt ) 

temp 5 


else i f ( conn t e r __ k < 0 ) 


MPTR- >jy„tota - M P T R - > j y = t o t a .3. __ + ((float) ( 
/# + deadband#/) # MPTR-> jy . x__gain ) ; 

t e m p - M P T R - > j y « t o t a 1 _ x ( f 1 o a t ) M P T R - > d s . y a w_. s 

MPTR->ds „ yaw_pos - (int) temp; 


t e rr* p •- M P T R — > j y . t o t a 1 _ + ( f 1 o a t ) M P T R - > d s „ y a w, _ s t a r t p 
MPTR— >ds. yaw_pas = (int) temp; 

j' 

/#pr intf ( "y_.pos = %d \n" ? MPTR->ds.yaw_pos) ; %/ 

*v 

J 


i f ( ! v i ew_f 1 ag ) 

r 

L 

Lock Brakes ( ) ; 

t. e t c o 1 o r ( B L A CK ) ; 
t e x t b a c k g r o u n d ( W HITE) ; 
gotoxy ( 15,22) ; 

print-)- ( " V. 3f " ,MF‘TR->py . pitch_ang ) ; 
gotoxy (15,23 ) 5 

p r i n t f ( " % . 3 f " , M P T R — > py.y a w_ ang ) ; 
textco 1 or ( WHITE ) ; 
t e x t b a c k g r o u n d ( E< L A C K ) 5 
v i e w_ f 1 a g — T R U E ; 


MPTR- >ds . p i tch_ve 1 — ( i nt ) ( MPTR— >ds » p i tch_pos - MPTR->od » p i tch_pos ) 5 
MPTR->ds „ vaw vel = ( int )( MPTR— >ds . yaw pas - MPTR->acLyaw..pos ) ; 


M P s K - > od.pi t cn_pos = M r i K — > ds.pit c h_po s s 
M P T R -- > a d „ y a w_ p o s = M P T R — > d s.ya w__ p o s s 

/ Ipr i nt-f ( p = Xu. y = Xu \n ! ' ? MF'TR— >ds . p i tch_pos , MPTR— >ds . yaw_pos ) ; %/ 

n 

S 

/ %%%%%%%%%% % % % % % & % % % % % % t 
% m o v e s t h e a r m w i t h t he j oyst i c k 
# inputting command values 
t * * 1 1 1 % % * % % % t % 1 1 % t # * t * 1 1 / 


void Joyst ick_Oper at ion ( void ) 

'i. 

Set__Clock__Lip ( ) 5 
En ab .1 e_AD_ Into r r up t ( ) 5 
Get__Jo i nt_Dat a ( ) 5 
jad_check — 0; 

In it ial_System ( ) 5 
G e i:__ J o y_ P o s i t. i o n ( ) 5 
while ( RUN _ ARM ) 


j ad_chec k++ 5 
i f (jad__check > 15000 ) 

r 

ERROR .FLAG = AD_FAIL; 
RUN ARM FALSE 5 

T 

S 

while (START LOOP) 


G e t _ J o i n t. __ D a t a ( ) 5 
Rea d__ Joyst ick ( ) 5 
Joy_Error_Check ( ) 5 
i-f (button__l) 

f 

Ca lcul at.e_Dr i vs ( ) 5 
Motor_._Dr i ve ( ) § 

J 

J a y_ M o t i a n__ D a n e ( ) 5 
Data„Record ( ) 5 
jad_check = 0 5 
START _L 00 P = FALSE; 


Lock_Brakes ( ) ; 
Unset__Clock ( ) s 
D i s p 1 a y___ E r r o r ( T R U E ) ; 
Date,_Save ( ) ; 


/ 5j( 1 1 k%% t # !jc % % %%%%%% % $ % t 1 1 % t 

t FILE s NASAB.C 

t DATE; December 20., 1990 

% 

k ROUTINES 
>K M_Mot i on_Done 

$ M_Get_.Commanri._Pos i t i on 

t M_Error_Check 

k M_ Calc u 1 a t e__, P o s i t i o n 

k M_Galculate_Dr i ve 

t H_Command_Qper at i on 

t M_Save_Path_F i le( ) ; 

k M_ 6 et._Path_Fi le ( ) 5 

* 
k 

t k % % % %k% % kkkkkkkk k k kkkt k k / 


# include 
#inc lude 

# i n c 1 ud e 
# include 

# i n c .1 ud e 


" ext data . h " 
" nasadet „ h " 
<dos » h > 

<con i a . h> 
<std io . h> 


/ k % k # % jk % t t * % jjc % % % t %% % % % )fc % % 

* DATA 

% k % % % kkkk % k k k k k k k k $ k k k k k / 


i n t 

m_sof t_p i tch_T 1 ag ; 

i n t 

m_sof t_yaw_F 1 ag ; 

x n t 

m_ad_check r, 

i n t 

m t 1 oop r, 

•i !•». 4- 
J. I 1 L. 

j un k ; 


/ % % * % % % % k kkkk kkkkkkkk k k k k 
k routine to check when joint motion is done 
k on commanded position as been reached 
k k k t k k t % % * k k k k kkkk k k k k k k / 


v a i d !T_ M o t i o n__ D o n e ( v a i d ) 


i n t c h e c k p, che c k y ; 


a_p i t 


w ) 


i T ( ( abs ( MPTR->py » p i tch_pos 
h ) 

c h e c k p = T R U E $ 
e 1 s e c h e c k p = F A L 3 E j 
it ( ( abs ( MPTR->py » yaw_pos - 


c 'n e c k y - J T R U E 5 
e 1 s e chec k y = F A L S E r, 

/ k t est k / 

/ 1 chec k p = F A L S E ; 

c h e c k y — : 1 - A L. fa' L 5 
it ( -iunk 250 1 


- m t _ f i n a 1 __ p i t c. h [ m t_ 1 o o p ] ) 


mt_f ina l_y aw [ mt_ 1 oop J ) ) 


<> MPTR 


MPTR- 


>sp » del t 


delta_ya 


Mi cheeky) 


eheckp = TRUE ; 
c. h eck y = T R U E 5 
)• */ 

i-F (checkp 


RUN_ARM = FALSE f 

ERROR_FLAG = N 0 R i v ! A L__ SHUT D O W N % 

mt_loop = mt_loop + 1; 


/ # % % % % % % & $ % % % % % % % % % % % % % % % 

# routine to get joint path 
% 

% %%%%%%%%%%%%%%%%%%%%%%% / 


vo i d M_Get_Path_F i 1 e ( vo i d ) 

r 

\ 

FILE $par am_Fi le #Fapen(); 

c h a r n a m e [ 1 2 ] 3 

int loop? 

int it.mp5 

■float. ftmp? 

u n s i g n e d s h a r t u s t m p 3 


W U. W fl V V lj W / II 

eputs ( "ENTER IN FILE NAME "); 

g o t o x y ( 4 5 , i 5 ) 5 

f lushal 1 ( ) ? 

so an -f ( " X 1 2 s " , n aine ) 3 

param_file = f open ( name , "r" ); 

i F ( p a r a m__ File ~ ~ N U L L ) 


gotoxy ( 50 , 24 } ; 
eputs ( "FILE ERROR" ) ? 
sound ( 500 ) 3 
delay ( 1500 ) ; 
nosound ( ) 5 
del ay ( 7500 ) 3 


q o t a x y ( 5 0 , 24 ) ? 

printf ( "WORKING" ) 5 

•f sc an f ( pa r am_f i 1 e , " Xd ", & i t mp ) ? 

mt_(noves = it mp? 

/%pr intf ( "moves — %d\n " , mt.__moves ) ? 
d e 1 ay ( 2000 ) 5 1 / 

-for (loop — 1? loop <= mt_moves 3 ++loop) 


F s c a n F (par a m_ File, 

"Xu." , 

&ustmp ) ; 

m t_ F i n a 1 _ p i t c h [loop] 

= ustirip ; 

Fscan F ( p a r am_F i 1 e , 

"Xu" . 

8<ust.mp ) 5 

mt_F i na l_yaw [ 1 oop j 


= ustmp 3 

F scan F ( p a r a m__ File , 

"Xu" , 

3 <u.stmp ) 5 

m t. __ s t e p s [loop] 


ustmp; 

FscanF (param_F i 1 e , 

"Xd" , 

H-'i. tmp ) ? 

mt_de 1 ta p i tch_pos 

[ 1 oop ] 

= itmpg 

F s c anf (par a rn_ F i le , 

. " Xd " , 

& i tmp ) 3 


m t_ d e 1 1 a _ y a w_ p o s[ lo o p 1 
■f s c a n -F ( p a r a m__ -f i. 1 e , " % F 1 ' 

mt_p i tch_ang 3 . e [ 1 oop 3 
f scan F ( p a r am__F i 1 e , “ %F " 
m t __ y a w_ a n g 1 e [ 1 o o p 3 
Fsc an F ( p a r am_F i 1 e , " XF ” 
m t d i t c h s t e n 1" 1 a a o 1 


— itmpg 
S-d'-tmp ) ? 
= Ftmp 3 
i-.:ftmp ) 3 
Ftmp 3 
& Ftmp ) ? 
Ft. mo 5 


OJHGi 

OF 


3 E 


■f sc an f ( p a r am_f i I e , " %f " , ?<f ■ t mp ) 5 

m t__ y a\ w_ stepEloop] = f t m p ; 

f scant ( param__f i le , "%f", ?<f tmp ) 5 

mt_t i met 1 oop j ’ ' = f tmp 5 ’ 

/% printff "final pitch = %u\n", mt_-Fi nal_p i tch[ 1 oop 3 ) ; 

pr intf ( "f inal yaw = %u\n" , mt__f inal_yaw[ loop li ) ; 
pr intf ( "steps = %u\n" ,mt_steps[ loop ] ) ; 

pr int-f ( "delta pitch = %d\n“, mt_delta_pitch__pos[ loop] 5 ; 

pr int-f ( "delta yaw = %d\n“ , mt_delta_yaw_pos[loap]) ; 

pr intf ( “pitch angle = %f\n", mt__p i tc.h_ang le[ loop ] ) ; 

p r i n t f ( " yaw ang 1 e = %-f \.n " , mt_yaw_ang 1 e C 3 . oop ] ) ; 

pr int-f ( "p itch step = ”vf \n 11 , mt_p i tch_stepC loop ] ) 5 
pr intf ("yaw step = %f\n" , mt__yaw_step [ loop 3 ) ; 
p r i nt-f ( " t i me = V.f \n " , mt_t i me L 1 oop ] ) ; 
del ay ( 2000 ) ; % / 

\ 

f c 1 ose ( p a r am_f i 1 e ) ; 


/ 1 >i< t * 1 1< t 

* routine to save joint path 
& 

ft * ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft ft * ft ft ft ft ft / 


vo i d M_Save.__Pat.h__F i 1 e ( vo i d ) 
\ 


F I LE ftpar am_f i 1 e , ft fop en ( ) 5 

c h a r n a m e [ 1 2 ] 

int. loop 5 


qotoxy (20, 15 ) ; 

cputs(" ENTER IN FILE NAME 

gotoxy ( 45 ,, 15 ) ? 

•f 1 ushal 1 ( ) ; 
s c a n f ( 1 ' "/. 12s", n a m e ) 5 
param__-file ■■= fopen (name, "w" ) ; 
if (param_.fi le == NULL) 

■•w 

g ot o x y ( 50 , 24 ) ; 
cputs ( "FILE ERROR" ) 5 
sound ( 500 ) ; 
delay ( 1500 ) ; 
nosound ( ) ; 
del ay ( 7500 ); 


got a x y ( 50 , 24 ) ; 
printff "WORKING” ) ; 

f p r intf ( par am_.fi le , "%d\n", mt_moves) ; 
for (loop = 1; loop <-• mt_moves ; ++loop) 


f p r intf ( p a r a m_ 

■file, 

"7,u\n " 

3 

mt_ 

f inal_p itch[ loop] ) ; 

f p r .i n t f ( p a r am_ 

f i 1 e , 

"Xu\n " 

H 

m t_ 

f j. n a l_y aw [ 1 oop j ) ; 

f p 1 - i n t f ( p a r a m_ 

file, 

"7.u\n" 

3 

mt_ 

steps [ 1 oop J ) ; 

f p r intf ( p a r an>_ 

f i 1 e , 

" %d\n " 

3 

mt__ 

d e 1 1 a_p i t c h_p os [ 1 00 

f p r i n t f ( p a r a m__ 

f i 1 e , 

"7.d\n " 

f 

mt_ 

de 1 ta_yaw_pos L 1 oop ] 

f p r i n t f ( p a r am_ 

file, 

"%f\n" 

3 

mt _ 

pitch_angle[ loop] ) ; 

■f p r i n t f ( para m__ 

f i 1 e , 

"%f \n " 

H 

mt_ 

yaw_ang 1 e [ 1 oop ] ) ; 

f p r i n t f ( p a r am.. 

file, 

"%f \n " 

3 

mt_ 

p i. tch_step L 1 oop ] ) ; 

f p r i n t f ( p a r am_ 

file, 

"7.f\n" 

u 

mt_ 

yaw_step C loop ] ) ; 

f p r i n t f ( p a r am_ 

f i 1 e , 

"%f\n" 


mt_ 

t i meC loop j ) ; 


fc 1 ose ( p a r am_f i 1 e ) ; 


/ * * ft ft ft ft ft ft ft ft ft ft ft ft ft 'ft ft: ft ft. ft ft ft ft ft 


Jfc routine to get. desired position o-f the joint 
>k 1 1 1 1 * Y & $ $ ft >): $ # * $ # >jc >k # 1 1 1 / 


void r 


tl 


Get__Command_Pasi t ion ( void ) 


f 1 oat 

va 1 ue ; 

f 1 oat 

1 ow_ limit; 

f 1 oat 

h i gh_ limit; 

i n t 

moves ; 

short 

temp ; 

unsigned int 

steps 5 

int 

flag; 

i n t 

y-j 

0 

0 

char 

answer ; 

unsigned int 

t emp__p .i t c h [ 2' 

unsigned int 

t emp__y aw C 20 ] 

mt_ counter = 

0; 

t e x t c 0 1 0 r ( B L A C K ) ; 

t extbackg r 0 u n 

d( WHITE) 5 

g ot 0 x y ( 20 , 15 ) 

H 

eputs ( "ENTER 

BY FILE OR HAND 

gotoxy ( 52 , 15 ) 


f lushal 1 ( ) ; 


answer = f get char ( ) ; 


if ((answer ~= 'H’ ) ! ! (answer ==• ’h’)) 

'l. 

do 


flag = TRUE 5 
g o t o y ( 2 0 , 1 5 ) 5 

cputs( "ENTER NUMBER OF DESIRED MOTION STEPS (MAX 10) 

gotoxy ( 68 , 15 ) 5 

s c a n f ("/id", S; m o v e s ) 5 

if (moves > 0) flag - FALSE; 

wh i 1 e ( f 1 ag ) q 
(iit_inoves moves ; 

t emp__p i tch Cl] - MPTR~>py „ p i tch__pos ; 
temp_yaw [ 1 ] = MPTR->py = yaw_pos p 

t e x tool o r ( WH I TE ) ; 
text background ( BLACK ) 5 
g o t o x y ( 2 0 , 15) p 
c 1 reel ( ) ; 
t e x t c o 1 o r ( B L A C K ) ; 
textbackground ( WHITE > ; 

for (loop - Ip loop <- mt_movBS ; ++loop) 

r 

g ot o x y (20,15); 

p r i n t f ( " ENTER ' VALUES FOR MOT I ON %d " , 1 oop ) p 
do 

r 

L 

flag = TRUE; 
goto x y ( 20 ,, 1 6 ) ; 

cputs(" ENTER DESIRED MOVE TIME (seconds) 

gotoxy ( 58 ,16); 

s c a n f ( "“if" , S ', v a .1 u e ) ; 

if (value > 0.0) flag = FALSE; 

\ 

while (flag); 

mt_t i me C 1 oop ] - va 1 ue ; 

do " 


•Clan == TP! IP « 


got ok y £ 20 , i 7 ) ? 

c p ut s ( " ENTER I N DES I RED P I TCH ANGLE 

J 5 

got ox y ( 58 , 17) p 
scant ( "X-f" , Stvalue) p 

1 qm_ limit = ( ( -P 1 oat ) ( MPTR— >sp . p i t c h_ 1 o_a 1 a r m — l v 
P T R — > s p . p i t. c h _ n eutral ) / 6 5 5 3 6 . 0 ) p 

1 ow__ limit = (1 ow_ limit t 360 , 0 ) — 360 . 0 p 
h i gh_ limit = ( ( f .1 oat ) ( MPTR—>sp . p i tch_h i_.a 3. arm -- 
MPTR~>sp «pitch_neutral ) / 65536,0) p 

high_limit — high_ limit % 360.0? 

if ((value < high_limit) && (value > .low__l imit. ) ) 

4- 1 ag = FALSE? 

■V. 

J 

while (Flag)? 

mt_pitch_anglef. loop] = values 
value = (value # 65536.0) / 360.0? 
mt_delta_pitch_pos[ loop j •- (int) value; 

mt_Final_p itch [ loop ] -• (unsigned int) ( MPTR-->sp . p it.ch_._ns 
u.tral + mt_.de 1 ta_p i tch_pos[ loop 3 ) p 

do 


flag = TRUE? 
got ok y ( 20 , IB) p 

cputs ( " ENTER IN DESIRED YAW ANGLE 

" ) 5 

gotoxy ( 56 , 18 ) p 
sc anf ( " %f " ? S<va 1 ue ) p 

1 o w 3. i m i t = ( ( f 3. o at) ( M P T R •- > s p . y a w_ 3. o__ a l a r m — M P T 

R - > s p . y a w n e u t r a 1 ) / 6 5 5 3 6 . 0 ) ; 

low_ limit = (low_ limit t 360,0) 360.0? 

h i g h__ 1 i m i t = ( ( f 1 o a t ) ( M P T R - > s p . y a w_ h i __ ala r m - M F 

T R - > s p . y a w_ n e u t r a 1 ) / 655 3 6.0) ? 

h i g h_ limit -- h i g h__ limit # 36 0 , 0 p 

if ( (value < high_ limit) && (value > low_ limit)) 

flag = FALSE? 


wh i le ( f 1 ag ) ; 

mt__yaw_ang 1 e C 1 oop ] va 1 ue p 

vs 1 ue = (value & 655-36 . 0 ) / 360 . 0 p 

mt_delta_yaw_pos[ loop ] ~ (int) value? 

mt_f inal_yawC loop)] - (unsigned int) (MPTR-->sp .yaw_neutral 
+ m t d e 1 1 a_ y a\ w_ p o s C 1 o o p j ) p 

mt_steps[ loop] — (unsigned int) ( mt_t ime[ loop ] (float) 

!~ k 1 0 Li E N C Y ) p 

/% p r i ntf ( "mt_f i na l_p i t ch = %f temp_pitch = %f \n" , (float ) mt_final_pitc.hr loop] ? 
( f 3. oat ) temp_p itch[loop])p 

pr intf ( "mt__f inal_yaw = 7.f temp_yaw = 7f \n " , ( f loat ) mt_f inal_yaw[ 1 oop ] , (flc 

at ) temp__yaw C. 1 oop j ) p %/ 

mt_p i tc h_st ep [ 3. oop 3 = ( f 1 oat ) ( ( ( f 1 oat ) mt__f i na l__p itch [ 1 c 
a p j ( f 1 a a t ) t e m p__ p i t. c h i 1 o a p 3 ) / ( f 1 o a t ) m t_ s t eps[loop])p 

mt_yaw_step [ loop 3 - (float) ( ( (float )mt_final._yawC loop 


( Float ) temp_yaw[ loop J ) / ( float ) mt_steps[ loop 3 ) p 

temp__p i tch T. 1 oop + 13 — mt_final_p itch [ loop ] ; 
t e m p_ y aw[ loo p +13 ~ m t_ F i n a 1 _ y a w [ 1 o o p ] p 


/ 1 p r intf("loop = % d \ n ‘ 1 , 1 o o p ) p 

p r i n t f ( " mt__st ep s = %u\ n " , mt_st ep s [. 1 oop 3 ) p 

pr intf ( "mt__final_p itch = 7»u mt_pitch_step “ Xf \n 11 . rnt__.fi nal_p itch C loop ] , mt_pitc. 
h_.step [ loop 3 ) p 

printf ( "mt_f inal_yaw ~ Xu mt_yaw__step -- Xf\n " , mt_f inal_yaw[ loop ] , mt_yaw__st 

ep 1 1 oop 1 ) ? 

pr intf ( "temp_p itch = Xu temp_yaw = Xu\n " f temp._p i tch C loop+1 3 9 temp_yaw[ 

loop+1 3 ) p t/ 

t e t c o 1 o r ( W H I T E ) ; 


gotoxy ( 20 , 15 ) ; 
c .1 rea 1 ( ) 5 
goto x y (20,16) 5 
c 1 r 0 a 1 ( ) 5 
g a t a x y ( 20 . 1 7 ) ; 

C 1 r" 0 D i ( ) p 
gatoxy ( 20 ,18); 
c 1 rea 1 ( ) ; 
t e x t c a 1 or ( EfL ACK ) 5 
textbackground ( WHITE ) ; 
gatoxy ( 20 ,15); 

cputs'( "SAVE PATH IN A FILE YES or NO (Y •ar N) 
gatoxy ( 60 ,15) ; 
f lushal 1 ( ) ; 
answer = fgetchar ( ) 5 

if ( (answer == ’ Y ’ ) ! i (answer == ’y’ ) ) 

M_Save__Path_Fi le( ) ; 

e 3. so 

M_Get_F'ath_Fi 1 e ( ) ; 
f lushal 1 ( ) 5 

mt__p i tch_pos = MPTR~>py » p i tch_pas ; 
m t _ y a. w.._ p o s = M P T R — > p y , y a. w_ pas; 

MPTR-~> od p i tch_pos = mt_p i t ch_pas ; 

MF'TR~>od . yaw__pos = mt_yaw_pos ; 

fnt__p i tch._ start. -• !iPTR->py , p i tc:h__pos ; 

mt_yaw_start = MPTR->py .yaw_pos ; 

t e x t c o 1 o r ( B L. A C K ) ; 

t e x t b a c k gra u n d ( W H I T E ) 5 

gat axy ( 50 , 24 ) 5 

c put s ( "WORKING" ) ? 

t e x t c a 1 a r ( W H I T E ) 5 

t e x t. b a c k g r o u n d ( B L A C l< ) 5 

gatoxy ( 20 „ 15 ) 5 

c 1 real ( ) ; 

g at a y ( 2 0 , 1 6 ) ; 

clreal ( ) ; 

g o t. o x y ( 2 0 ,, 1 7 ) ; 

c 1 real ( ) ; 

gotoxy ( 20 , 1 8 ) ; 

c 1 r so .1 ( ) ; 


/ % %%%%%%%%%%%% $ t # % $ t 

t routine to check for proper arm (joint) operation 
% check motor and joint limits 
% % % # * % % % % % % % % % * t % % % t % % t % / 


v o i d M_. E r r o r _ C h e c k ( v aid) 


■j. f 

i f 

if 

i F 

i f 
i f 


( MPTR->py , p i tch_pos > MPTK->sp p i tch_h i__ 1 i m i t. ) 

ERR0R_FLAG = P_H I_L I M I T r, 

( MPTR— >py , p i tch__pos < MF’TR-Osp .pitch_lo_l imit ) 

R R 0 R_ F L A G = F‘__ L 0 __ LI M I T ; 

( M P T R - > p y . y a w_ pos > M P T R > s p , y a w_ h i __ 1 i m i t ) 
ERR0R_FLAG = Y_HI_LIMITs 
(MPTR->py , yaw_pos < MPTR— >sp , yaw_lo_l imit) 

ERROR FLAG - Y L0 LIMIT; 

( ERROR _FLA 6 1= FALSE) RUN_ARM = FALSE; 

( MPTR->py , p i tch_pos >= MPTR- > sp „ p i tch_h i__a 1 arm ) 
MPTR->sp . s 1 i mi t_p i tch = .1. ; 


( MF' T R— > p y . p i 

Ivlf-'T'O •••. r- 


ch_pos 


<= MPTR— >sp .p itch_lo_alarm ) 

4 4- •? „ 


/♦check for#/ 

/ # -f a. t { ? v l 0 r r o r 


X. 


i f ( M P T R - > p y . y a w__ 

pos >= 

MPTR-j 

>sp . yaw 

_h i_ 

_a 1 arm ) 

MF'TR— >sp * 

s 1 i m i t._ 

_yaw = 

i ? 



i f ( M P T R - > □ y . y a w_ 

pos < — 

~mptr-; 

: -sp . yaw 

_lo_ 

.alarm ) 

MF'TR- >sp. 

s 1 i m i t_ 

_yaw = 

-1 3 ’ 




/ if. % % % k t $ % t % 1 1 % * % 1 1 % % * % % % % 

% routine to find the next desired joint position 

* input -from commanded position or the joystick 

* % >!: % * t % % % $ t * if # * * % t % % %%t% / 

vo i d M_Ca leu 1 at e_F'os i t i on ( vo i d ) 
f 1 oat temp 3 

it (mt_counter < = mt_st ep s [ mt__ 1 oop ] ) 

temp = ( mt_p i tch__step [mt_loop ] % (float) mt_counter ) + (float) m 

t__ p i t c h _ s t a r t ; 

mt__p i t.ch_pos = (int) temp p 
MPTR”>ds ■ p itch__pos = mt_p itch_ pos 3 

temp = (mt_yaw_step Lmt_loop ] * (float) mt__counter ) + (float.) mt_ 

v a w s t a !■■ t « 

mt__yaw__pos = (int) temp 5 
MPTR->ds » yaw_pas = mt__yaw__pos ; 

/% printf("/»u %u\n " , mt__p i tch_pos mt_yaw._pos ) 3 %/ 


mt_counter += 1 ; 

if ( mt__counfcer =~ (2 t m t __ s t e p s [ m t _ 1 a a p ] ) ) 

RUN ARM = FALSE 5 

if (MPTR-->sp„sl.i.m.it_pitch 1 = 0 ) ERROR.. FLAG = S 0 FT_LIMIT_P; 
else if ( M P T R -- > s p s 1 i m i t _ y a w 1 = 0 ) ERROR FLAG = SOFT LIMIT V? 
else ERRQR_FLA6 = TIME._OL.IT5 
mt__loop ■” mt_ loop + 1 3 


mt_p i tch_vel = ( int ) ( mt_p i tch_pos ••••• MPTR— >od «pitch_pos) 3 
mt_yaw_ve.l = ( int ) (mt_yaw_pos - MPTR->od . yaw_pos ) 3 
MPTR-->od » p i tch_pos = mt__p i tch__pos 5 
MPTR— >od „ yaw_pos = mt_yaw_ pos 5 


/ if. % >}; % %%%% # t % %%%% % % % % % t * * t 

% routine to find the motor input (drive) values based 
t on system conditions, angles desired and angles true 
% t % t % % % if. % % & tt% * if t< if % t %%%% / 


v o i d M. _ 0 a 1 c u 1 a t e__ D r i v e ( v o i d ) 


float 
f 1 oat 
f 1 oat. 
f 1 oat 
i n t. 
i n t. 


d if fa , d iff bp 
d i f f av , d i f f b v p 
tacha, tachb 3 
d r i v e a 3 d r i. v e b 3 
pitch, yaw 5 
p ,i. t c h v , y a w v 3 


/#find if soft limits are in effect*/ 
i f ( M F' T R — > sp.s .1 i m i t _ p i t c h ! — F A L S E ) 


m_so-ft__p.itc.h_-F lag — i; 

MPTR—>od = s 1 i m i t_p itch = MPTR— >py p i tch_pos s 

J* 

e 1 se i f ( MPTR— > sp . s i i m i t_p itch == 1 ) 

•f 

if ( MPTR— >py . p i tch_pos >= MPTR->od . si i mi t_p i tch ) mt_pitc 
h_pos = liPTR->od s 1 imi t_p itch ; 

\ 

0 ] 00 

.r 

\. 

if ( mt_p i tch_pos <— MPTR— >od « si i mi t_p i tch ) mt_pitch_pos 

= M P T R — > o d .si imit_pitch 5 


else m_soft_pitch_f lag = Op 

if ( MPTR— >sp . si imi t_yaw != FALSE) 


if ( m_sof t_yaw_f lag 


o 1 


- > ad „ s 1 i m i t__y aw ; 


m_sof t_yaw_f lag = 1 ; 

MPTR— > ad . s 1 i m i t__yaw = mt_yaw_pos 5 


else if ( MPTR->sp . si imi t_yaw == 1 ) 


if ( fnt__yaw__pos >- MPTR— >od . si imi t_yaw ) mt_yaw_pos = MPTR 


e 1 s e 


if (mt_yaw_po 5 <= MF'TR~>od „sl imit_yaw) mt_yaw_pos — MPTR 


• od . s 1 i m i t_y a w ; 

*v 

J 

T 

J 

e 3. s e m_ s a f t _ y a w_ f 1 a g = 0 5 


/ # f i n d m a t a r A d r i v e s .1 g n a 1 & / 
/ t f i n d m o t o r B d r i ve sign a 1 % / 


p i t c h 
yaw 

p i t c h v 
yawv 
d i f f a 
d i f f b 
d i f f a v 
d i f f b v 
tacha 
tachb 
d r i vea 
d r i veb 


= mt_p i tch_pos - MPTR— >py . p i tch_pos 5 
= M P T R - > py.y a w_ pas — m t _ y a w_ p a s ; 

- mt_pitch_vel — MPTR— >py . pitch__vel 5 

- m t. _ y a w_ v e 3. — MPT R — > py . ya w_ v e 1 5 

= — (MPTR— >gn . A_pasit ion $ ( f 1 oat ) (pitch + yaw) ) n 
-= MPTR— >gn . B_posit ion t (float) (pitch yaw):; 

- ( M P T R — > g n „ A_ o u t p u t _ v e 1 % ( f .1 o a t ) ( p i t c. h v + y a w v ) ) ; 

~ ( MPTR->gn . B__output_vel # (float) (pitchv - yawv))? 

= MPTR— >gn . A_motor_vel t (float) (MPTR— >ma . tach ) j 

= MPTR— >gn . B_raotor_vel # (float) ( MF'TR->mb . tach ) ; 

- diffa -I- diffav - tacha; 

- diffb + diffbv — tachb; 


/#pr intf ( "dr i vea/b "if ”/,f\n " ;i drivea, dr iveb ) ; #/ • 

M P T R - > m a . mo t_ d r i v e = ( ( ( i n t ) ( d r i vea)) t M P T R - > g n , d i r e c t i o n ) 
MPTR— >mb . mot_dr i ve = (((int) (drived)) t MPTR— >gn . direct ion ) 
/#printf("dfa ”/.f dfb %f dfav %f dfbv "if dva %f dvb Xf \n " d if fa. , d if- f b 


b v ,, d r i vea ,, d r i veb ) \ %f 


/ % p r i n t f ( " d r i v e a % d 


% d \ n ’ ' , M P T K - > m e.mo t._ d r ive, M P T R - > ra b » m o t_ d r i v e 


-i- 20 4 S ; 

20 4 S ; 

d i -f f a v , d i ff 
5 %/ 


/ 1 % t % % % t %%% % t $ # % t % t % % %%%% 

% performs the moving of the arm ORIGINAL PAG 1 ^ 

t given the final pitch and yaw angles Qp POOR QUALITY 

>K will check for errors and final position 
t % t % 1 1 * t % t % %.t % 1 1 % t % t # % 1 1 / 


i d M_ C o m (n a n d_ 0 p e r a t i o n ( v o i d ) 

Set_Clack_Up ( ) ; 

Enab le_AD_Inter rupt ( ) 5 
I n i t i a l_8ystem ( ) 5 
M_Get_Comsnand_Posit ion ( ) ; 
m_ a d__ c h e c k = 0 ; 

Unlock_Brakes( ) ; 
mt_Ioop = 1; 
do 

y 

u 

mt_counter - 0; 

mt_p i tch_pos = MPTR— >py - p i tch_pos ; 

mt_yaw_pos = MPTR— >py . yaw_pos ; 

MPTR— >od . p i tch_pos = mt_p .itch__pas; 
MPTR— >od . yaw_pos == mt__yaw_pos 5 

mt_pitch__start = MPTR— >py . p itch__pos; 

mt_yaw_start = MPTR— >py « yaw_pos ; 

R(JN_ARM = TRUE? 

ERROR_FLAG = FALSE; 
while (RUN_ARM) 

r 

L 

m_ad_chec k + + 5 

i-F (m_ad_check > 15000 ) 

r 

ERROR_FLAG = AD_F A I L ; 
RUN_ARM = FALSE; 
mt_loop = mt_moves + 1 

J* 

while ( ST ART_L 0 QP ) 

Get_Joint_Data( ) ; 

M_Ca 1 c u 1 at e_ Pos i t i on ( ) 
M__ E r r o r _ C h e c k ( ) 5 
lr__ C a 1 c u. .1 a t e__ D r i v e ( ) 5 
Motor_Drive( ) 5 
M_Mot i on_Done ( ) ; 

Da ta_ Record ( ) ; 
m_ a d _ c h e c k = 0 r, 

S f AR i _L 0 QP = F ALSE ; 


while (mt.__.loop <= mt__moves); 
Lock_Brakes( ) ; 

Unset_Clock ( ) ; 

D i s p 1 a y__ Error (T R U E ) ? 
Data_Save( ) 5 



& FILES NAS AD AT A * H 

* DATES July 28, 1990 
t 

* 

# 

t ttttt'kkt $ * * * t ********** * / 


i n t 

OPERATE § 

/*f lag to stop program*/ 


i n t 

81 AR i LOOP’ ; 

/*flag for sync operations */ 


i n t 

RUN_ARM j 

/ * f 1 £\ q t o a 1 1 o w a rm o p e r a t ion s * ,< 


i n t 

ERROR_FLAG r, 

/*flag to hold the cause of the 

shutdown * / 

int 

F'ARAMt. ! ER FLAG ^ 

/ % f 1 ag to inform system of data 

parameter 

i n t 

LOG_CNT 5 

//'counter f o r cl a t a 1 o g g i n g * / 


int 

LQG_REV 5 

/ * f 1 a g f o r ci a t a 1 o g 1 o o ping a n :i 

Itself*/ 

struct MTR 




c hi an g e * / 


1 nt 


tach ; 

:i. n t 


res_vel 5 

i n t. 


t. 0 r q 5 

unsigned 

int 

res_cnt ; 

float 


res_ang $ 

unsigned 

i n t 

res_rev 5 

i n t 


mot__d r ive: 

unsi qned 

c h a r 

b rake ; 




unsigned 

i n t. 

p itch__pos s 

int 


p i tch_ve 1 ; 

unsigned 

int 

old__p itch; 

f .1. 0 a t 


p i tch_ang ; 

unsigned 

int 

y ci w pos q 

i n t 


yaw_ve 1 ; 

unsigned 

i n t 

old_yaw ; 

f 1 oat 


yaw_ang ;; 


DESIRED 

r 



un si gned 

i n t 

p itch_pos ; 

uns i gned 

i. n t. 

yaw_pos ; 

unsigned 

i n t. 

f inal_p itch ; 

uns i gned 

i n t 

final yaw j 


original page is 

OF POOR QUALITY 



unsigned 

int 

counter ; 

unsigned 

int 

p i.tch_start ; 

unsigned 

i n t 

yaw__start ; 

int 


del ta__p i tch_pos 

int 


d e 1 1 a_ y a w_ pos; 

■f 1 oat 


p i tch_ang le ; 

f 1 oat 


yaw_ang le ; 

•f 3 . oat 


p i tch_step 5 

int 


p i tch_ve .1 ; 

f 1 oat 


yaw_step ; 

int 


yaw_ve 1 ; 

•float 


t i me 3 


truct SETPOINT 


unsigned 

i n t 

p itch_hi_l imit ; 

uns i gned 

int 

p i t c h_ h i __ a 1 a r m 3 

unsigned 

int 

p i t c h_n eutral ; 

uns i gned 

int 

p .i. t c h_ 1 o__ a 1 a r m 5 

unsigned 

int 

p i t c h_ 1 o_ limit; 

uns :i. gned 

int 

del ta__p itch ; 

unsigned 

i n t 

yaw _h i__ 1 i m i t ; 

unsigned 

int. 

yaw_h i_a 1 arm ; 

uns i gned 

i n t. 

y a w_ n e u t r a 1 3 

unsigned 

i nt 

yaw_ 1 o__a 1 arm ; 

unsigned 

int 

yaw_ 1 o_ 1 1 m i t ; 

uns i gned 

i n t; 

del ta_yaw ; 

int 


si imit_pitch ; 

int 

■ 

{S 


si imit_yaw; 


truct GAIN 


■f 1 oat 

A... 

. p 0 5 _mot i 0 n_ 5 C a 1 e 5 

f 1 oat 

A_ 

v e 1 _ m 0 1. i 0 n_ s c a 1 e ; 

-F 1 oat 

A_ 

motor _vel ; 

f 1 oat 

A-.. 

torque; 

•f 1 oat 

W 

posit ion ; 

f 1 oat 

A_ 

output__vel ;; 

f 1 oat 

B_ 

pos_mot i on__sca 1 e s 

float 

B_ 

ve l_.mot i on_sca 1 e 

■f 1 oat 

Ef_ 

motor_vel ; 

■F 1 oat 

B_ 

torque ; 

•f 1 oat 

B_ 

posit ion ; 

float 

B 

output_vel ; 

i n t. 

di 

rection ; 

s 




u n s 

i gned 

int 

p i tch_pos s 

uns 

i gned 

i n t 

yaw... pos ; 

uns 

i gned 

int 

si imi t_p i tcri 

uns 

i n n sci 

int 

si imit yaw 3 


T 1 IJrt L. A y cl i ! J i, 

•float y_.qa. l n % 


struct MAIN 


st ruct 

MTR 

ma 

st ruct 

MTR 

mb 

st ruct 

PY 

PY 

st ruct 

DESIRED 

ds 

st ruct 

SETPOINT 

sp 

struct 

GAIN 

gn 

struct 

OLD 

od 

s t r uc t 

JOY 

jy 


M, #MPTR ; 


/ 1 1 1 % t tt% t % t * % %%%%% % tttt t 
t arrays -for mult moves 
>?: * % * >f- % 1 1 * t tttt 1 1 * # ./ 


unsigned 

i n t 

m t_p i t c h_p os \ 

uns i gned 

int. 

mt_y aw_p os ; 

unsigned 

i n t 

mt_f i na l_p itch [103 j 

unsigned 

int 

mt f i n a l_yaw [ 1 0 ] s 

un s i g n ed 

i n t 

mt_s t ep s [ 1 0 ] 5 

unsi gned 

int 

mt_counter p 

unsigned 

i n t 

mt_p itch_start. ; 

unsigned 

int 

m t _ y a w_. s t a r t r, 

int 


mt_.de lta_p it ch_pos[ 10] 5 

i n t 


m t__ del t a__ y a w_ p 0 s [ 1 0 ] 5 

•f 1 oat 


mt_p i tch_ang 1 e [ 1 0 ] ; 

f 1 oat 


mt__.y aw_ang 1 e [ 1 0 ] ; 

•f 3 . oat 


mt__pitch_step[ 10] 5 

i n t 


mt_._p i tch_.ve 1 ; 

•float 


mt_.yaw_.step [ 103 5 

int 


mt_yaw_ve 1 5 

■f 1 oat 


mt_t i me [ 10] 5 

i n t 


mt_ moves ; 


/ 1 1 1 tttfffftttt % %%%%%%%% % % t 
t arrays for data logging 
& >i< % t # %. t % % % % %%%% % % % % % % % t % / 


# d e r i n e 


1 og. 

_ range 1250 

i n t 


1 og. 

_ t a c h__ a [ 1 0 g_ r a nge] ; 

int 


1 og. 

... t a c h_ b [ 1 0 g_range] ; 

int 


1 og_ 

_ 1 0 r q_ a [ 1 0 g__ r an g e ] ; 

int 


log.. 

_torq_b[ log_.range] 

unsigned 

i n t 

1 og. 

_res_cnt_a[ loq__ range] ; 

i n t 


1 QQ. 

... r e s_ r e v_ a [ 1 0 g__ r a n g e ] ; 

unsigned 

i n t 

1 og. 

_res_cnt_b[ log._range] ; 

i n t 


1 og. 

_ r e s_ r e v_ b [ 1 0 g__ ran g e ] ; 

i n t 


log. 

_motor_c(nd_a[ log_range] 5 

i n t 


1 og. 

_motor_.cmd._b [ lag_range] , 

uns igned 

int 

1 og_ 

_pitch_pos[ iog_range] ; 

x n t 


1 og.. 

_ p i t c h_ v e 1 [ 1 0 g r an g e j ;; 

unsigned 

i nt 

1 og_ 

_yaw_p os [ 1 og_r ange ] ; 

i nt 


log. 

_yaw__vel [ log_ range] p 

i n t 


log. 

_ cJ e s i r e_ p i t c h._ p 0 s [ 1 o g__ r a n g e ] p 

1 n Z 


log. 

_desi re_yaw_pos[ log_range] 



/ $ t # t $ % t % % %. % % % % % % % $ % % % % % % % 

4 FILES EXTDATA „H 

* DATE s July 28, 1990 

% 
t 
t 


% %%%%%%%%%%%%%%%%%%%% t % % t / 


e x t e r n 

int OPERATE;! 

/#f lag to 

e x t e r n 

i n f S T A R T__ L 0 0 P 5 

/#flag for 

extern 

int RUN_ARM; 

/ #f lag to 

e x t e r n 

int E R R 0 R_ FLAG; 

/#flag to 

e x t e r n 
*/ 

i n t P A R A M E T E R_ FLAG 

1 / >Lf lag to 

e x t e r n 

int LQG._CIMTq 

/^counter 

extern 

int L.0G__REV ; 

/#f lag for 

extern 

struct MTR 
int. 

tach ; 


i n t 

res_vel 5 


i n t 

tor q ; 


unsigned int 

res_cnt ■ 


•float 

res_ang q 


unsigned int 

res_rev r. 


i n t 

mot_d r i ve q 


unsigned char 

j' u 

b rake q 


e x t e r n s t. r u c t P Y 

r 


u 

unsi gned 

i n t 

p i tch_pos 5 

i n t 


p i tch_ve 1 q 

unsi gned 

j. n t 

0 1 d_p i tch q 

f 1 oat 


p i tch_ang q 

unsigned 

int 

yaw_pos q 

i n t 


yaw_vel q 

unsigned 

int 

0 1 d_yaw q 

f 1 oat 


V" c\ W dflCl q 

e x t e r n s t r u c t D E 

r 

SIRED 


unsigned 

i n t 

p i t c h_p os q 

unsigned 

i n t 

yaw pos q 

un s i q n ed 

int 

f i n a 1 p i t c 



stop program#/ 
sync operations %/ 
alio w a r m o p e r a t i o n s % / 
hold the c a u s e o -f t h e s h u t d o w n % / 
in -farm system of data parameter change 

•for data logging#/ 
data log looping an itself#/ 


ORIGINAL PAGE IS 
GE POOR QUALITY 


tinai yaw |i 

steps r, 
counter ; 
p i tch_start 5 
yaw_start 5 
delta_p i tch_pos ; 
delta_yaw_pos ; 
p i tch_ang le ; 
yaw_ang 1 e 5 
p i tch_step ; 
pitch__vel ; 
yaw_step ; 
yaw_vei : 
t i me ; 


extern struct SETPOINT 

jr 

unsigned int 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
unsigned int 
i n t 
int 

"r .. 

J q 


extern struct GAIN 

r 

L 


■float. 

A_pos_mot i on. 

_scale; 

■f 1 oat 

A_ve l__mot i on 

_scale; 

■f 1 oat 

A__motor__ve 1 ; 


float 

A torque; 


float 

A__pos i t i on ; 


f 1 oat 

A_ 0 u t p u t __ v e .1 

5 

f 3 . oat 

B_ p 0 s__ mo t i 0 n. 

_scal e 5 

float 

Ef__ v e 1 _ m 0 1 i 0 n 

tr> C. c'A 1 0 !) 

f 1 oat 

B__ m 0 1 0 r __ v e 1 ; 


f J. oat 

B__torque ; 


f 1 oat 

B__posit ion s 


f 1 oat 

B__ou t p ut_ ve 1 

5 

int 

d i rect ion ; 



p itch_pos ; 
yaw_po5 r, 
s 1 i mi t__p itch ; 
s I i m i t_yaw ;; 

struct JOY 

r 

i n t b li 1 1 a n_ 2 5 

f I q a t t o t a 1 5; 



p i tch_h i_ 1 i 1 T 1 i t ; 

p i t c h h i __ a 1 a r m 5 

p i tch__neu.tr a 1 ; 

p i t c h 1 o_ alar m s 

pit c h__ 1 o_ limit; 
del t a__p itch; 
y aw__ h i_ limit; 

V a w__ h i _ a 1 a r m 5 
y a» w_ n e u t r a 1 ; 

V a w__ 1 a__ a .1 a r m ; 
yaw__ 1 o__ 1 imit ; 
de 1 ta_yaw ; 

si imit__pitch 5 
s 1 i m i t__yciw ; 



extern 


+• j. oai 

tota i_y ; 

■F 1 o a t 

x_gain r, 

•float 

y__gain p 

•}' 5 



ex t e r n 

struct MAIN 

r 



st ruct 

MTR 

ma 5 


st ruct 

MIR 

mb p 


struct 

PY 

py 5 


st ruct 

DESIRED 

d s 4 


struct 

SETPOINT 

sp ; 


st ruct 

G A I N 

gn 5 


st ruct 

OLD 

ad p 


st ruct 

JOY 

JV j 


3- M , 

♦MPTR; 


/ $ % % % % t % % % & 1 1 $ % % % 1 1 1 # t >K % t 


# a r r 

a y s f o r rn u 1 1 m o v e s 


t % 1 1 >K * % % if. % % % tttt t % t $ t % * $ / 


e t e r n 

unsigned 

int 

mt__p i tch_pos ; 

e x t e r n 

unsigned 

i n t 

mt_yaw_pos p 

e t e r n 

unsigned 

i nt 

mt_f i na l_p i t c h [ 3 p 

e x t e r n 

unsigned 

i n t 

mt_f i n a l__yaw £ 1 p 

extern 

unsigned 

i nt 

rnt_stepsL j s 

e t e r n 

unsigned 

i n t 

mt_ counter 5 

e x t e r n 

un s j. g n ed 

i n t 

mt_p i t c h_st a r t p 

e x t. e r n 

unsi gned 

i n t 

m t __ y a w__ s t a r t p 

e x t e r n 

i n t. 


mt_.del ta_.p i tch_pos[ ] 5 

e x t e r n 

i. n t 


mt_del ta__yaw_pos[ ] ; 

e x t e r n 

■float 


mt__p i t c h__ an g 1 e [ ] 5 

e x t e r n 

f 1 oat 


mt__yaw__ang let 'j p 

e x t e r n 

float 


rnt_p i tch_st ep [ ] 5 

e x t e r n 

int 


rnt__p itch_vel 5 

extern 

float 


mt._yaw.__st.ep [ j 5 

extern 

i n t. 


mt_y aw_ ve 1 p 

extern 

float 


mt_t ime[ ] p 

e x t e r n 

int 


mt__moves ? 



/ * % % %%&%.%%$%%%%%%%%%%%%%% 
t arrays -for data logging 
% % %%%% % % %%%%%% t % % 1 1 % % % t % / 


#def i rie 

1 

og_r 

ange_e 


e x t. s r n 

int 


1 og_ 

,tach_aC log_range_e] p 

0 x t © r 1 *! 

int 


1 og_ 

tach_b[ 3. 0 g_ r an g e__e ] p 

extern 

i n t 


1 og_ 

torq_a[ log_range_e] p 

e t e r n 

i n t 


1 oq_ 

1 0 r q_b C 1 og_ r an g e_e ] p 

e x t e r n 

unsigned 

i n t 

1 OQ_ 

res_cnt_a[ log_range_e] p 

e k t e r n 

i n t 


1 og_ 

r e s r e v a £ .1 0 g _ r a n g e _ e J p 

e x t e r n 

unsi gned 

i n t 

log_ 

r e s c n t _ b [ 1 0 g_ r a n g e_ e ] p 

0 x t. e r n 

int 


1 og_ 

res rev bf_ log_range_e] p 

e x t. e r n 

int 


log._ 

motor_cmd_a[ 1 og_ r an g e_.e ] p 

e x t e r i"i 

i n t 


1 og_ 

motor_cmd_b C log_range_e] P 

e x t e r n 

unsigned 

i n t 

1 OQ 

p itch_pos[ log_range__e] p 

extern 

int 


log_ 

p i t c h_ve 1 [ 1 og_ r an g e_e ] p 

e x tern 

uns i gned 

int 

1 og__ 

yaw_pos C I og_r ange_e ] p 

e t s r n 

i n t 


.1 og_ 

yaw_vel £ log_range_e] r, 

extern 

i n t 


log_ 

d e s j. r e__ p i t c h_ p 0 s £ 1 0 g__ r a n q e__ e ] p 

extern 

i n t 


1 og_ 

d e s i r e v a w 0 0 s £ 1 0 g range e] ; 


/ ♦ ♦ ♦ ♦ ♦ ♦ ♦ ♦ ♦ ♦ ♦♦♦♦♦♦♦♦♦♦♦♦♦♦ ♦ 

♦ FILES NASADEF.H 

♦ DATE; July 28, 1990 

♦ 


♦ 

♦ ♦ ♦ ♦ ♦ ♦ »? % ♦ ♦ ♦ % ♦ ♦ t % ♦♦♦♦♦♦♦♦♦ / 

#def ine TRUE 1 

#d e-fine FALSE 0 


/♦ A/D D/A ~ I/O control definitions ♦ / 


#def i ne 

AD_BASE 

0x330 

#def ine 

AD LOW B 

0X330 

#def ine 

AD HI B 

0 x 33 1 

#d ef i n e 

AD SCAN 

0x332 

# define 

I 0_0UT 

0x333 

#def ine 

10.... IN 

0x333 

#def ine 

dao_low 

0x334 

#def i ne 

DAO HI 

0x335 

#def i ne 

DAI LOW 

0x336 

X® define 

DA i__H I 

Ox 337 

# define 

AD STATUS 

0x338 

#def ine 

AD CON 

0x339 

#def ine 

AD_T1'ME 

Ox 33a 

#def i. ne 

AD_GA I N 

Ox 33b 

#def i ne 

AD CNTR 0 

Ox 33c 

#def i ne 

AD CNTR 1 

Ox 33d 

#def i ne 

AD CNfR 2 

0x33e 

#def :i. ne 

ADc_C0N 

0x33f 

# define 

GAIN. 1 

0x00 

# d e f i n e 

GAIN 500 

0x03 

#def i ne 

I NT_0FF 

0x53 

#def i ne 

I NT..0N 

0xd3 

# define 

CLR_ I NT 

0 x 00 

# d e f i n e 

LOCKJB 

0 x 03 

#def i ne 

UNL0CK_B 

0x00 

#def i ne 

I NTR LOC 

OxOd 

#def i ne 

I NT_MASK 

0x80 

#def i ne 

AD SET 

0 x 00 


/♦interrupt #5 8< off, counter start®/ 
/♦interrupt #3 & on, counter start®/ 
/♦write to status reg only to clear®/ 
/♦.lock the motor brakes®/ 

/♦unlock the motor brakes®/ 

/♦interrupt vector for interrupt # 5 ♦/ 
/♦mask for checking EOC flag®/ 


/ ♦ A / D c h annel d e f i n i t i o n s ♦' / 


#daf i ne 

AD_ 

TACH 

_A 

0x00 

#def i ne 

AD 

TACH 


Ox 1 1 

#def i ne 

AD_ 

T URU 

A 

0x22 

#def ine 

AD 

TORO 

B 

0x33 

#def ine 

AD_ 

RD V 

A 

0X44 

#def i ne 

AD_ 

RD V 

.B 

0x55 

itdef i ne 

AD 

RD v 

p 

0 x tb o 



/ 1 K e s o i v e r d e f i n i t i o n s t / 


#def ine 

BASE 

0x300 

#daf ine 

LSB 

0x300 

#def i ne 

MSB 

0x301 

#def ine 

s_c 

0x302 

#def i ne 

ERR 

O x 3 O 3 

d e -F i n e 

M__A_R 

0 x 30 

l^B^&def ine 

m~b_R 

0x3 i 

#def ine 

P_LO 

0x32 

#d e-fine 

P_H I 

0x33 

#de-F i ne 

Y__LO 

0x34 

#def ine 

Y_H I 

0x35 

#d e-fine 

LOOP_MASK 

Ox OP 

#def ine 

LOS_MASK 

0 x 1 0 

tt-de-f i ne 

BIT MASK 

0x20 


ORiGSNAL PAGE tS 

OF POOR QUALITY 


/ # sh ut down def i n i t i ons * / 


#def i ne 

P_H I __L. I M I T 

0x0001 

#d ef i ne 

P_L0_LIMIT 

0x0002 

#def ine 

Y_ H I LIMIT 

0 x 0004 

#def i ne 

Y_L0_LIMIT 

0x0008 

#ri ef- :i. n e 

RESOL VER_ERR0R 

OxOO j O 

#def ine 

RESET 

0x0020 

#def ine 

TIME ..OUT 

0x0040 

#def ine 

SOFT L I M I T_P 

0x0100 

# define 

SOFT LIMIT Y 

0x0200 

#def i ne 

AD_.FA I L 

0x0400 

# define 

N OR M A L_. S H L J T D 0 W N 

0x8000 

/# speed 

of loop rate per second*/ 

#d ef i n e 

FREQUENCY 

250 

/Mef int 

i o n s -F o r f i n d i n g t h e 

motor di-i 

#def i ne 
12B) 

SCALED_.REMOTE._YAW 

( ( MPTR— > 

#def i ne 

SC ALED_REMOTE_P I TCH 

( ( MPTR— >' 

/ :i. 28 ) 



#def ine 

DECOUPLED PCS ERR A 

( — ( SCALE 

#def ine 

D E C 0 U P L E D_ P 0 S_ E R R_ B 

( SCALED_ 

#def i ne 
/ 128) 

SCALED _P I TCH_VEL__ERR 
MF‘TR->py c p i tch_.ve 1 ) 

( ( ( MPTR- 

#def ine 
1 28 ) - 

SCALED YAW VEL ERR 
MF‘TR-->py „ yaw_vel ) 

( ( (MPTR- 

# define 

DECOUPLED. _VEL_ERR_A 

( SCALED_' 

#de-f ine 

DEC 0 U P L E D_ V E L._. E R R_ B 

( SCALED_ 

— #define 

•* 

S C A L E D _ M 0 T 0 R_ V E L_ A 

( ( MPTR— >( 

# define 

SCALED MOTOR VEL B 

( ( MP ! R— >i 

#d ef i n e 

SCALED. ,T0RQ_A 

( ( MPTR— >i 

#def i ne 

SCALED TORO B 

( (MPTR-->( 


SCALED REMOTE YAW ) 


(( ( MPTR->qn „ ve l_mot ion_sca 1 e % MPTR->ds . yaw_ve 1 } / 


SCALED_P I TCH._VEL._ERR ) 


